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摘要 


水 下 航行 右 作 为 一 种 新 型 的 水 下 勘测 平台 , 在 车 事 和 民用 领域 有 着 巨大 的 肥 
展 前 景 ,在 水 下 航行 问 动 力学 分 析 中 往往 将 航行 右 与 其 周围 的 流体 介质 视 做 一 个 
机 械 系 统 。 航行 如 在 运动 过 程 中 通过 与 流体 介质 相互 作用 ， 完成 相应 的 动作 。 由 
于 水 下 航行 右 周 围 的 流体 介质 存在 阻尼 , 两 者 相互 作用 机 理 比 较 复 森 , UTT a 
周围 流体 介质 组 成 一 个 非 线 性 、 强 厢 合 的 机 械 系 统 。 

本 文 在 读 题 组 以 往 研 客 的 基础 上 ， 从 能 量 的 观点 出 ， 通 过 引入 微分 几何 方 
法 对 水 下 航行 融 进 行 建 模 分 析 ， 得 到 水 下 航行 套 基 于 微分 几何 理论 的 动力 学 模 
型 。 以 读 题 组 研 肥 的 混合 张 动 水 下 靖 著 邦和 和 天 量 推进 式 水 下 目 主 航行 右 为 分 析 对 
Fey WARE AST ae AB SET FE, NABI SRA, BEAT KP UAT at 
“AIAN ABS. SE BU AAT TRO AT RA. EVA 
试验 对 比 ， 验 证 动力 学 模型 的 正确 性 ,为 后 续 研 究 基 于 微分 儿 何 理论 的 控制 系统 
提供 动力 学 模型 。 

本 文 的 主要 研究 成 来 如 下 : 

1. 针对 水 下 航行 堆 在 流体 介质 中 运动 的 特点 ， 从 能 量 的 角度 出 及， 推导 出 
通用 的 水 下 逢 行 融 动力 学 方程 。 水 下 贞 行 希 作 为 一 种 特殊 的 机 械 系 统 ， 由 其 质量 
所 阵 引入 歼 曼 度量 ， 对 水 下 航行 大 的 动力 学 模型 进行 几何 推导 ,得 到 水 下 舱 行 大 
基于 微分 几何 理论 的 动力 学 模型 。 

2. 通过 对 混合 驱动 水 下 滑翔 机 PETREL-I 系统 分 析 , 得 到 其 简化 系统 模型 ， 
将 简化 系统 模型 受 力 情况 代入 到 动力 学 模型 中 ,进行 仿真 分 析 。 仿真 结 末 与 试验 
数据 对 比 ， 验 证 了 柑 型 的 正确 性 。 

3. 通过 对 矢量 推进 式 水 下 目 主 航行 如 系统 分 析 ， 得 到 该 系统 的 简化 模型 ， 
将 该 系统 受 力 悄 况 市 入 到 动力 学 模型 中 ,进行 仿真 分 析 。 仿真 结 果 与 试验 数据 对 
比 ， 验 证 了 模型 的 正确 性 。 











FE]: 水 下 航行 器 ; 动力 学 建 模 ; 微分 几何 ;数值 仿真 


ABSTRACT 


Underwater vehicles as a new type of underwater reconnaissance platform, has a 
great development prospect in the field of military and civilian. In underwater vehicle 
dynamics analysis, the vehicles and the surrounding fluid are treated as a mechanical 
system when they are analyzed. The vehicles complete the appropriate motion 
through the interaction with the fluid in the process of movement. The vehicles, with 
the surrounding fluid, form a strong coupling nonlinear mechanical system due to the 
complicated interaction mechanism with the damping fluid. 

Based on the previous studies of the research group, with the introduction of 
differential geometry method and the viewpoint of energy, the underwater vehicle 
system is analyzed and the unified geometric dynamics model of underwater vehicle 
is obtained. The hybrid underwater gliders and vectored thrust underwater 
autonomous vehicle are analyzed. Through the specific analysis of the underwater 
vehicle system, the system property is obtained. Then the specific property is 
substituted into the unified geometric underwater vehicle dynamics model. 
Underwater vehicle space kinematics and dynamics numerical simulation in six 
degrees freedom are analyzed. Through the simulation analysis and comparison of 
lake sea trial test, the unified geometric underwater vehicle dynamics model is 
verified. This provides the dynamic geometry model framework for the control 
system based on differential geometry theory in the future research. 

The following contributions have been derived: 

1. By analyzing the characteristics of the underwater vehicle moving in the fluid 
circumstance, from the viewpoint of energy, the dynamic equation of underwater 
vehicle is deduced. According to the characteristics of the special kind of mechanism 
system, Riemannian metric is introduced to represent the underwater vehicle mass 
matrix. Then through the derivation of the dynamic geometric model, the dynamic 
unified model for underwater vehicle is obtained. 

2. Based on analyzing the system of hybrid underwater glider, the simplified 
system model is obtained. Then the simplified model is analyzed in the unified 


geometric underwater vehicle dynamics model. The model is simulated in the way of 


II 


numerical simulation. By comparison with the sea trials, the results of numerical 
simulation and the unified model are verified. 

3. Through analyzing the system of vectored thrust underwater autonomous vehicle, 
a simplified system model is obtained. Then the simplified model is substitute into the 
unified geometric underwater vehicle dynamics model. The model is simulated in the 
way of numerical simulation. By comparison with the sea trials, the results of 


numerical simulation and the unified model are verified. 


Key words: Autonomous Underwater Vehicle; Dynamics Model; Differential 


Geometry; Numerical Simulation 
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1.1 引言 


2] 世纪 人 类 已 经 进入 了 开 及 利用 海洋 的 时 代 。 海 洋 占 据 看 地 球 表 面积 的 
71%、 地 球 上 总 水 量 的 97%， 姓 庸 置 疑 的 成 为 全 球 生命 文 持 系 统 的 一 个 基本 组 成 
部 分 。 相 对 于 陆地 广阔 的 海洋 强 纠 者 丰富 的 矿产 资源 、 生 物资 源 和 能 源 。 占 地 表 
面积 的 49% 的 海洋 属于 国际 海 展 区域 ， 访 区 域内 的 资源 不 属于 任何 国家 、 组 织 。 
对 海洋 的 探索 、 研 究 ， 已 经 引起 了 世界 各 国 的 广泛 关注 ， 必 是 成 为 一 种 有 助 于 实 
现 可 持续 发 展 的 宝 贯 财 军 。 因 此 ， 人 全面 深 入 认识 海洋 、 合 理 开 发 利用 海洋 和 保护 
海洋 具有 重大 的 战略 意义 ”。 

随 看 我 国 的 涉 海 行为 的 频繁 和 深入 , 及 展 海 洋 经 济 已 经 提升 到 了 国家 战略 的 
高 度 ， 走 同 远海 、 深 海 已 成 必然 趋势 。 为 了 更 好 的 开 友 、 利 用 、 保 护 海洋 资源 ， 
需要 长 时 间 的 对 海洋 进行 观测 和 考察 ， 进 行 大 量 的 研究 工作 和 科学 实验 ” 。 

水 下 航行 颖 作为 一 种 新 型 的 海洋 甚 测 平台 ， 可 以 搭载 多 种 勘测 设备 ， 如 蜗 度 
ih CTD DL AK REB S BEN. HESPIEIETEPIBDXETI IRIN FE. DXANUEE. J DARE 
HE ZUM, WSR UREA RPSL IAS. = AERA, 7J8 iE RUE H 
貌 、 海 洋 生 物 分 布 、 海 水 状态 变化 等 方面 的 全 方位 的 海洋 勘测 模型 服务 "1。 

目前 作为 实时 、 在 线 监 测 的 水 下 央行 句 ， 主 要 分 为 载 人 航行 器 (Human 
Occupied Vehicle, 简称 HOV) MEAK FB ty a (Unmanned Underwater Vehicle, 
简称 UUV ) 。 其 中 无 人 水 下 航行 器 投 照 与 水 面 工 作 基 站 的 联系 不 同 ， 又 可 分 为 
无 人 遥控 式 水 下 航行 名 (Remotely Operated Vehicle， 人 简称 ROV) 、 无 人 目 主 式 
水 下 航行 器 (Autonomous Underwater Vehicle， 人 简称 AUV) 以 及 无 人 目 主 式 水 下 
滑翔 器 (Autonomous Underwater Vehicle， 简 称 AUG) Pl FEAR EIK PEUT. 
a ACA EL EAK PH SICA REPEC PAULI dS THEG, OB EIS HER. TA 
照 既 定 的 任务 要 求 可 以 在 大 沁 围 内 进行 海洋 勘测 调 僵 ,在 大 泡 围 、 长 时 序 、 大 纵 
深 的 涉 海 行为 中 ， 拥 有 更 广阔 的 前 景 。 
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第 一 章 绪论 


1.2 无 人 水 下 航行 器 的 研究 发 展 状况 





从 20 世纪 中 后 期 开始 ， 世 界 上 许多 国家 、 科 研 组 织 面 癌 不 同 的 任务 有 要求 ， 
研制 了 多 种 结构 和 性 能 水 下 航行 促 ， 目 前 已 有 数 白 种 水 下 航行 旨 作 为 两 品 出 售 ， 
并 在 不 同 的 海洋 开 肥 领域 中 及 挥 看 重要 的 作用 。 


1.2.1 水 下 自主 式 航 行 器 发 展 状况 


水 下 目 主 式 航 行 器 采用 预 编 程 的 方式 , 依 徘 其 携 市 的 能 源 ， 在 布 放 之 后 到 达 
目标 水 域 完 成 相应 的 勘测 使 命 ， 达 到 目 治 的 能 力 。1950 年 到 21 世纪 初期 ， 水 下 
目 主 式 航 行 费 经历 了 了 诞生、 发 展 并 走 同 成 熟 的 过 程 。 

20 世纪 70 年 代 中 后 期 ， 在 关键 搁 术 上 的 进步 以 及 国外 产业 界 、 军 方 的 大 量 
和 资金、 技术 的 投入 ， 为 人 们 探索 AUV 潜在 用 途 提供 了 必要 条 件 ， 一 系列 不 同型 
号 的 AUYV 试验 平台 相继 建成 。 在 此 期 间 , 华盛顿 大 学 应 用 物理 实验 室 在 SPURV 
的 基础 上 ， 改 进出 新 一 代 AUV, SPURV-I 以 及 UARSK 1， 美国 新 罕 布什 尔 州 
KÆ (University of New Hampshire) Ul Hi —3XJF2879 AUV-EAVE, ; 美国 海 
军 空间 和 海战 信息 中 心 CSPAWARO 开展 “先进 无 人 搜索 系统 (Advanced 
Unmanned Search System, AUSS) ”项 目 , 1983 年 AUSS 型 AUV 成 功 进行 海 试 ， 
并 取得 预期 的 效果 ; 法 国 科学 家 成 功 研 制 出 世界 上 第 一 艘 6000 米 级 别 的 深 洪 
AUV “pf CEPAULARD) ”， 标 志 着 AUV 的 探索 领域 走向 深海 “。 

20 世纪 90 年 代 到 2007 年 ， 随 看 各 研究 机 构 的 不 断 投 入 , 与 AUV 相关 的 新 
技术 不 断 涌现 ， 在 此 期 间 AUV 研究 进展 迅猛 。 据 不 完全 统计 ， 此 间 20 年 的 时 
H, 世界 上 AUV 的 总 数 迅 速 增加 , 数量 由 不 到 20 艘 迅速 增加 到 400 ARH. AUV 
的 相关 应 用 领域 也 得 到 相应 的 拓展 , 从 前 期 的 军事 应 用 方面 , 例如 海洋 战场 侦 得 、 
水 下 反潜 、 战 场 水 域 排 雷 以 及 水 中 兵 问 的 运载 、 布 放 等 任务 ， 扩 展 到 民用 领域 ， 
如 海洋 资源 探测 、 海 洋 环境 监测 、 海 洋 地 质地 貌 调 得 、 海 洋 生 物 系统 研究 、 海 详 
打 所 与 救援 、 海 洋 设施 的 布 放 和 维修 等 。 

1991 年 至 1992 F, R HRA L Wil Massachusetts Institute of Technology, 
人 简称 MIT) 7K FLAM H SCUS EAR SCE da BE e 5 R m 27 FS A 
THE. MR URS RU AE TUI] C3D 多 波束 声响 的 新 型 AUV 一 Odyssey 78. (REI ) 
和 Odyssey-II 型 (奥德赛 改进 型 )， 并 进行 了 大 量 的 海 试 试验 ”中 。1992 年 美国 
佛罗里达 大 西洋 大 学 (Florida Atlantic University) 的 先进 海洋 系统 实验 室 

(Advanced Marine Systems Lab〉 开 友 出 能 够 目 主 的 适应 海洋 动态 坏 境 因 系 ， 对 
海底 地 形 进行 自主 勘测 的 AUV 一 Ocean Explorer (海洋 旅行 者 号 ) P, 90 年 代 
初 美国 伍 效 鹤 尔 海洋 研究 所 (Woods Hole Oceanographic Institute，WHOI) 研制 
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第 一 草 绪论 


成 功 ABE (Autonomous Benthic Explorer) 型 AUV， 并 于 1994 年 完成 第 一 次 科 
学 考察 … 。1992 年 美国 海军 研究 生 院 (Naval Postgraduate School, NPS) 研制 
FX A ATT, AY DASE KC BR TE Ved EIE CREE 7JXETI AA BU WU HS. Aries 型 
AUVP:I*PI, 1995 年 英 家 海洋 学 中 心 (National Oceanography Centre, NOC) 
开始 了 面向 海洋 科学 调查 和 军事 应 用 的 AUTOSUB-1 型 AUV DEFEAT. SE 
的 新 罕 布什 尔 州 (New Hampshire) 目 治 水 下 系统 研究 所 (Autonomous Undersea 
Systems Institute , AUSD) 与 俄罗斯 远东 科学 院 水 下 技术 研究 所 联合 开发 出 利用 太 
PHREEK F H Aisy SAVU (Solar-powered Autonomous Underwater Vehicle) ， 其 最 
终 计 划 是 开发 出 一 稻 具 有 一 年 续航 能 力 的 航行 器 "。1998 年 美国 伍 效 霍 尔 海 洋 
研究 所 研制 出 了 远程 海洋 环境 监测 仪 (Remote Environmental Monitoring Unit, 

REMUS) ， 用 于 近海 勤 硅 、 探 测 和 目 动 采 样 ， 并 用 美国 HYDROID OKIE) 

公司 进行 商品 化 、 系 列 化 ， 现 已 被 挪 威 康 斯 但 格 〈Kongsberg Maritime) 公司 收 


jg 1925] ! 








(a) (b) (c) 
图 1-1 MIT. FAU, NPS 三 种 典型 AUV 
(a) MIT Odyssey 型 AUV (b) FAU Ocean Explorer AUV (c) NPS Aries 型 AUV 





(a) (b) (c) 
图 1-2 US-Canada、NOC、 美 - 俄 三 种 典型 AUV 


(a) US-Canada Theseus 型 AUV (b) NOC AUTOSUB #! AUV (c) 美 - 俄 SAUV Æ AUV 


日 本 以 东京 大 学 工业 科学 研究 所 (University of Tokyo Institute of Industrial 
Science, UTIIS) XÈ, FAEH FHAR EWER R2D4, Twin-Burger 1 


第 一 章 绪论 


&2、 “Tantan”、“Tri-dogl”、“TUNA-SAND” 等 小 型 水 下 自 航 行 器 。 日 本 
三 秋香 工业 开 友 出 能 够 进行 3500 米 深海 勘探 的 无 人 驾驶 潜水 桌 -“AUV-EX1”， 
并 成 功 进行 海 试 研究 "1。 丹麦 的 ATLAS MARIDAN 研制 出 的 典型 水 下 自 航 行 
器 Sea-Wolf, 已经 系列 化 生产 、 销售 外。 1997 年 , 冰岛 大 学 (University of Iceland) 
与 Teledyne Gavia ehf 公司 开始 合作 开发 Gavia 系列 AUV， 并 于 2000 年 首次 实 
现 商 业 化 ， 访 系列 AUV 在 冰 怠 国内 被 广泛 的 应 用 盏 事 、 海 洋 科学 调理 和 海洋 开 
RP, 2007 年 Gavia AUV Uk WIRA PÒ (Icelandic Centre for Research) 4153 
m W (Trade Council of Iceland) #2 Fok $ E 4 AY BHR Icelandic Innovation 


Award", 





图 1-3 UTIIS 三 种 典型 AUV 
(a) UTIIS R2D2 型 AUV Cb) Twin-Burger 型 AUV (c) Tantan 型 AUV 





(b) (c) 
图 1-4 UTIIS、 丹 麦 、 冰 岛 三 种 典型 AUV 
(a) UTIS Tri-dog 型 AUV (b) 丹麦 SeaWolf 型 AUV (c) 冰岛 Gavia 型 AUV 


进入 21 世纪 ， 随 着 各 国政 府 对 海洋 开发 的 重视 ， 海 洋 勘 测 开 发 由 近海 走 癌 
远洋 、 由 浅海 走向 深海 。 其 中 ， 美 国 对 AUV 的 研制 投入 最 大 ， 其 AUV 生产 研 
KILAŽE, AUV 类 型 及 科技 含量 均 处 于 绝对 领先 地 人 位。 挪威 Kongsberg 
Maritime 公司 、 美 国 Hydroid 公司 、 美 国 Bluefin Robotics AF], SRNE KARIR 
研究 所 CMBARD 、 以 及 冰岛 Teledyne Gavia ehf 公司 对 AUV 的 产业 化 、 系 列 
化 、 商 品 化 、 模 块 化 起 到 了 积极 的 推进 作用 一 。 
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挪威 Kongsberg Maritime 公司 于 上 世纪 80 年 代 开 始 研 制 以 科学 研究 为 目的 
的 小 型 AUV 系统 。90 年 代 初 期 ，Kongsberg Maritime 与 挪威 国家 石油 公司 
(Statoil ) 和 挪威 国防 研究 机 构 (Norwegian Defence Research Establishment , FFI) 
联合 开展 HUGIN 计划 ,研制 HUGIN 系列 AUV。 目前，HUGIN 系 类 AUV 已 经 
高 度 商 业 化 ,其 产品 根据 配置 不 同 分 为 HUGIN 1000, HUGIN3000 和 HUGIN4500 
系列 。 访 系列 AUV 可 以 根据 不 同 的 需要 搭载 不 同 种 类 的 仪 句 进行 海洋 测绘 ， 受 
到 世界 各 大 型 海洋 勤 测 公司 的 青睐 。 挪威 Kongsberg Maritime 公司 的 全 资 子 公司 
一 Hydroid 公司 生产 的 REMUS 系列 AUV， 现 已 经 形成 了 REMUS 100. REMUS 
600. REMUS 600-S、REMUS 6000 系列 产品 ， 型 号 涉及 个 人 手持 轻型 AUV 到 
深水 重型 AUV。 访 系列 以 其 高 度 的 模块 化 、 可 车 性 以 及 文 持 个 性 化 定制 ， 获 得 
盏 方 大 量 订单 。2013 年 9 H Kongsberg Maritime 公司 最 新 研制 的 紧 凌 型 MUNIN 
AUV 在 欧洲 海岸 下 水 海 试 ，MUNIN AUV 对 现 有 的 HUGIN 系列 和 REMUS 系 
列 进行 整合 , 具有 高 度 模块 化 .高 精度 、 高 可 靠 性 、 结 构 紧 凌 、 便 携 式 等 优点 一 ”。 
Kongsberg Maritime 公司 设计 MUNIN 型 AUV 由 在 运用 海洋 地 理 调查 级 别 
的 导航 定位 系统 收集 融 分 辨 紊 的 探测 声呐 数据 ， 达 到 海洋 地 形 地 貌 甚 测 、 海洋 调 
查 、 海 洋 监 测 的 目的 。 与 Kongsberg Maritime 其 他 系列 AUV 相 比 ， 在 拥有 相同 
的 性 能 和 测量 精度 的 情况 下 ，MUNIN 型 AUV 结构 设计 更 加 紧凑 ， 空 间 利用 率 
更 加 高 效 ， 布 放 、 回 收 更 便捷 。MUNIN AUV 的 特点 是 采用 模块 化 结构 设计 ， 具 
有 安装 额外 电池 包 的 能 力 ， 使 得 MUNIN AUV 工作 航程 更 大 ， 续 航 能 力 达 到 24 
小 时 ， 工 作 水 深 为 1500m 。MUNIN AUV 在 空气 中 整 机 质量 小 于 300kg ， 直 径 
为 34cm ， 长 度 按照 配置 不 同 介 于 3m-4m 之 间 ， 使 得 MUNIN AUV 成 为 世界 上 
最 轻型 、 最 紧凑 和 最 有 海洋 调查 能 力 的 水 下 机 器 人 之 一 。 尽 管 拥有 很 小 的 体积 ， 
MUNIN AUV 能 够 搭载 完整 的 水 下 调 碍 仪器 , 高 精度 导航 系统 和 声学 传感器 集成 
在 一 个 密封 舱 内 ， 搭 载 频 率 200-400 kHz、 波 束 角 1 x1. 416120 4y EM2040 多 
波束 回声 探测 仪 、 频 率 230/540 kHz 的 EDGETECH WAF, SORE URIBE 
和 避 障 声呐 、CTD 传感器 ， 底 部 还 可 以 选择 性 安装 浅 痢 声 员 和 摄像 机 。 

















图 1-5 Kongsberg Maritime 公司 生产 的 系列 AUV 
(a) HUGIN 型 AUV (b) REMUS 系列 AUV Cc) MUNIN 型 AUV 
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表 1-1 REMUS 和 HUGIN 系列 AUV 性 能 参数 


m 外 形 尺寸 DxL(mxm) 重量 (kg ) 续航 能 力 (h ) 最 大 下 潜 深度 (m ) 
REMUS 100 0.19x1.6 37 6-10 100 
REMUS 600 0.32x3.2 212 20-45 600 

REMUS 6000 0.67 x 3.94 863 28 6000 

HUGIN 1000 0.75 x 4.70 850 24 3000 

HUGIN 3000 1.00 x 5.50 1400 60 3000 

HUNGIN 4500 1.00 x 6.00 1900 60 4500 
MUNIN 0.34 x 3.00 小 于 300 12-24 1500 





我 国 水 下 航行 器 的 研究 工作 始 于 上 世纪 80 年 代 ， 目 前 还 处 于 试验 平台 的 研 
mj. 试验 阶段 ， 疝 未 商业 化 。 中 国 科 学 院 沈 阳 目 动 化 研究 所 于 1985 年 设计 制造 
出 HR-01“ 海 人 ”一 号 。 随 后 ， 天 律 大 学 、 哈 尔 演 工 程 大 学 、 上 海 交 通 大 学 、 
家 海洋 技术 中 心 、 浙 江 大 学 等 科研 院 所 相继 加 入 到 水 下 航行 器 的 研制 队伍 中 。 中 
科 院 沈阳 目 动 化 研究 所 相继 研究 出 “探索 者 ”号 AUV, “北极 ARV” . 6000 
米 级 别 的 “CR-01” 和 “CR-02” 深 水 AUV， 并 进行 一 系列 海 试 研究 ， 取 得 大 量 
宝贵 数据 一 。 

天 津 大 学 在 海洋 痛 备 技术 尤其 是 水 下 机 器 人 拉 术 研究 方面 进展 迅 狐 。2003 
年 天 痒 大 学 与 国家 海洋 技术 中 心 联 合 研制 出 可 以 坐 展 的 小 型 AUV， 并 多 次 进行 
湖 试 和 海 斌 试验， 取得 大 量 的 科研 数据 。2009 年 天 津 大 学 与 海洋 技术 中 心 合 
作 的 863 项 目 ，“ 小 型 水 下 目 主 观测 平台 ”， 取 得 南海 试验 的 成 功 。2010 年 天 
津 大 学 承担 国家 重大 科技 专项 子 课题 “深水 AUV 系统 设计 与 制造 技术 研究 ”， 
并 于 2012 年 成 功 研制 出 具有 矢量 推进 系统 、3000 米 级 别 的 深水 AUV 试验 平台 。 
该 深水 AUV 设计 工作 水 深 为 3000 米 ， 长 度 7.8 米 ， 采 用 流线型 回转 体 ， 最 大 直 
径 0.80 米 ， 尾 部 采用 混 联 机 构 矢 量 推进 单元 ， 以 减少 操纵 能 面 阻力 ， 提 高 航行 
器 的 低速 操纵 性 。 该 深水 AUV 试验 平台 多 次 在 湖 海 、 云 两 抚 仙 湖 进行 试验 ， 获 
得 大 量 珍 贯 的 试验 数据 。 








(a) (b) (c) 
图 1-6 国内 三 款 典 型 AUV 
(a) APT CR-01 AUV (b) 天 津 大 学 混合 驱动 AUV Co) 天 津 大 学 可 着 陆 式 AUV 





图 1-7 天 津 大 学 深水 AUV 


1.2.2 72K N78 2H 88 A FRETI DL 


经 典 的 水 下 清 翔 亏 概 念 是 由 美国 海洋 学 家 Herry Stommel 受到 用 于 大 气 环境 
监测 的 高 空气 球 的 启发 ， 于 1989 年 提出 ， 并 由 Teledyne Webb Research 研究 
室 研 制 出 第 一 台 水 下 滑翔 右 样 机 SLOCUM) ， 用 于 获取 海水 内 部 的 人 蜗 上 度 、 盐 
度 等 环境 信息 。 水 下 滑翔 器 在 自 喘 重力 不 改变 的 前 提 下 , 通过 依靠 改变 机 体 排水 
量 而 产生 的 一 定 的 将 浮 力作 为 其 驱动 力 , 配合 滑翔 右 机 体 提供 的 升力 将 单纯 的 垂 
直 运 动 转化 为 兼 有 垂直 运动 和 水 平 运动 的 合 运 动 。 通 过 采用 改变 滑翔 夯 机 体内 部 
质量 分 布 来 调节 滑翔 交 态 ， 从 而 实现 在 海域 中 的 剖面 滑翔 运动 。 水 下 请 翔 硕 以 其 
特殊 的 方式 提供 机 体 运 动 的 驱动 力 ， 工作 能 耗 亚 闭 减 少 ， 从 而 巡航 范围 和 在 线 监 
测 时 间 显 著 提 高 ， 具 有 一 定 的 持久 海洋 监测 能 力 ” 。 

水 下 滑翔 器 典型 代表 是 Webb 公司 生产 的 Slocum Electric Glider， 华 盛 顿 大 
学 (Washington University) 研制 的 Seaglider 和 Scripps 研究 所 开发 的 Spray 


Glider?! , 
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图 1-8 =a 7H XH ds 


(a) Slocum Electric Glider (b) Seaglider (c) Spray Glider 


近 些 年 来 , ADEL OTE SR SUK PIBORH SUI 5I" HET EJ PERS 大 
部 分 研究 处 于 样机 模型 设计 和 水 域 航行 性 能 试验 阶段 。2001 Æ, Teledyne Webb 
Research 研究 室 公 布 了 一 人 台 通 过 在 Slocum Electric Glider 尾部 增加 一 套 高 效 推进 
器 的 混合 驱动 式 水 下 滑翔 器 -Slocum AUV。2004 年 美国 多 家 科学 研究 组 织 以 该 
Slocum AUV 平台 作为 试验 测试 系统 , 对 Hybrid Glider 从 航行 的 经 济 性 能 和 滑翔 
速度 性 能 等 方面 进行 测试 评估 ， 评 佑 结 朱 指出 Hybrid Glider WTA. MH H 
的 和 未 来 研究 趋势 Pl。 

2004 年 加 拿 大 海洋 技术 研究 所 CInstitute of Ocean Technology) 的 
R.Bachmayer 研究 员 和 美国 普林斯顿 大 学 (Princeton University) 的 N.E.Leonard 
教授 等 人 设计 出 Hybrid Glider 的 概念 图 ， 通 过 对 该 样机 的 浮力 驱动 系统 、 机 械 
传动 系统 、 电 器 控制 系统 的 详细 设计 ， 研 制 出 Hybrid Glider 样机 ， 作 为 研究 测 
wra, 

2006 年 前 后 ， 日 本 海洋 研究 开 肥 机构 (JAMSTEC) 9r f — ESIK) 
IK PRES, AMAT ae AY PT oa LR a, 具有 民 好 的 水 动力 特性 ， 机 体 上 安装 有 可 
以 运动 的 腹 舵 、 尾 舱 、 机 四 等 操纵 机 构 ， 尾 部 冯 有 推进 装置 ， 能 够 根据 不 同 的 任 
务 需 求实 现 训 面 滑 翔 和 快速 推进 两 种 航行 运动 。 由 于 该 混合 驱动 水 下 航行 絮 的 玉 
用 展 好 的 水 动力 外 形 设 计 ， 同 时 具有 实现 训 面 清 翔 运动 的 能 力 ， 访 水 下 舱 行 茵 的 
航程 得 到 大 大 的 提高 中。2007 年 Florida Institute of Technology (FIT) 研制 出 
混合 驱动 水 下 滑翔 器 ( AUV Powered Glider) ， 两 个 能 够 独立 操控 的 螺旋 桨 推 
进 需 位 于 滑翔 右 尾 部 。 在 推进 模式 下 可 通过 两 个 独立 推进 需 的 相互 配合 实现 水 平 
TA LAG NUTT A Fe AIS, 依靠 机 体 上 的 请 翔 层 整体 翻转 实现 纵 平 面 上 的 下 洲 和 上 
浮 。 该 滑翔 器 的 滑翔 模式 依靠 浮力 的 改变 和 滑翔 翼 的 滑翔 功能 实现 。2009 
年 法 国 ACSA Underwater GPS 人 研发 了 一 台 水 下 滑翔 器 SeaExplorer. Ala ss 
的 螺旋桨 驱动 系统 位 于 机 体 的 做 部 , 通过 螺旋 桨 的 转动 提供 推力 以 实现 航行 堪 水 
PTAA TEBE. AIK RIP AS LAC LE, OR LAK PY PU as A A 
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测量 的 传感器 ， 可 以 对 目标 水 域 进行 长 时 间 的 在 线 监 测 1。 

2011 年 Teledyne Webb Research 实验 室 推 出 商业 化 的 混合 驱动 水 下 滑翔 郁 
Hybrid Slocum G2。 访 滑翔 右 在 典型 的 Slocum 电 驱 动 水 下 背 翔 右 尾 部 选择 性 安 
eS SRY ES A HTE AY te OR ESR. 使 得 山行 右 能 够 在 螺旋 熔 开 动 时 实现 快 
速 机 动 和 和 传统 的 浮力 驱动 剖面 滑翔 两 种 运动 方式 ， 以 达到 不 同 的 任务 需求 。 





图 1-9 几 称 典型 混合 张 动 水 下 滑翔 大 





(a) Webb 研究 室 Slocum AUV (b) Hybrid Glider 概念 设计 图 (c) JAMSTEC AUV 
(d) FIT AUV Powered Glider (e) 法 国 SeaExplorer (f) Webb 研究 室 Hybrid Slocum G2 


我 国 在 水 下 滑翔 器 技术 研究 方面 起 步 较 晚 ， 目 前 处 于 试验 样机 试制 研究 阶 
段 ， 主 要 研究 机 构 有 天 津 大 学 、 浙 江 大 学 、 中 国 科 学 院 沈阳 自动 化 研究 所 、 中 国 
船舶 重工 集团 公司 第 702 研究 所 、 上 海 交 通 大 学 、 西 北 工业 大 学 等 “。2003 fF, 
天 津 大 学 与 国家 海洋 技术 中 心 合 作 开始 研制 基于 温差 能 驱动 的 水 下 滑翔 器 试验 
平台 ， 于 2005 年 7 月 至 8 月 在 中 国 浙江 千岛 湖 进行 湖 试 “” 。2009 年 天 津 大 学 
研制 出 一 台 混 合 驱动 水 下 滑翔 器 PETREL， 该 平台 设计 工作 最 大 水 深 为 500 米 ， 
净重 300 千克 ,采用 传统 的 自主 式 水 下 航行 器 与 经 典 水 下 滑翔 器 结合 的 方式 ， 即 
在 典型 的 水 下 滑翔 器 尾部 增加 自主 水 下 航行 器 的 基本 驱动 单元 一 转向 尾 能 模块 
和 螺旋 桨 推进 单元 ”。2012 年 天 津 大 学 在 混合 驱动 水 下 滑翔 器 PETREL 的 基础 
上 ， 研 制 混 合 驱动 水 下 滑翔 器 PETREL-II， 其 包含 螺旋 桨 和 浮力 驱动 两 种 模式 。 
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该 滑翔 器 在 典型 的 水 下 滑翔 器 的 尾部 增加 螺旋 效 推 进 单元 , 具有 短 距 离 自 主 航 行 
及 水 面 定位 、 通 讯 能 力 和 大 航程 滑翔 能 力 。PETREL-II 混合 驱动 水 下 滑翔 器 已 经 
相继 进行 了 抚 仙 湖 湖 试 、 渤海 浅海 海域 、 南 海 海域 试 验 , 并 取得 珍贵 的 试验 数据 。 





图 1-10 天 津 大 学 研制 的 三 款 滑 翔 器 
(a) 温差 能 驱动 水 下 滑翔 器 样机 (b) PETREL 样机 (c) PETREL-II 样机 


1.2.3 微分 几何 理论 在 水 下 航行 器 的 研究 状况 


水 下 航行 器 在 水 介质 中 运动 ， 退 过 与 周围 流体 介质 之 间 的 相互 作用 ,能够 实 
现在 空间 六 自由 上 度 的 运动 ,在 水 下 航行 器 动力 学 分 析 中 往往 将 航行 颖 和 与 其 周 
的 流体 介质 视 做 一 个 机 械 系 统 进行 分 析 。 但 是 , 由 于 水 流体 介质 存在 阻尼 等 因 系 ， 
航行 铝 与 周围 流体 介质 组 成 一 个 非 线 性 、 强 耦合 的 机 械 系 统 ， 影 响 了 对 水 下 航行 
亏 的 控制 精度 。 因 此 控制 水 下 需 行 项 系统 是 一 个 较 困 难 的 问题 ， 人 例如， 鱼雷 形状 
的 水 下 航行 器 在 沿 前 进 方向 上 的 直线 运动 很 容易 控制 , 但 是 在 追踪 快速 移动 目标 
ERME, 

H Ai Es] P CRA SLA Le A EK PUT 88 8257] ETRE EAN 
KAA. MAZARE EH. ZK PUT ak REUS T AAEM IE ALMA, RE 
运用 微分 几何 理论 分 析 其 特性 。Leonard 利用 微分 几何 理论 研究 水 下 航行 器 ， 建 
六 了 水 下 航行 器 动力 学 的 微分 几何 框架 , 研究 在 无 界 的 、 理 想 流 体 中 重力 对 水 下 
航行 器 稳定 性 的 影响 。M. Chyba 等 人 利用 Leonard 所 提供 的 微分 几何 框架 
对 多 推进 装置 的 水 下 航行 器 进行 建 模 ， 并 对 Newton-Euler 方程 进行 几何 推导 ， 
引入 黎 受 度量 和 仿 射 联络 ， 建 立 基 于 微分 几何 理论 的 水 下 航行 医 儿 何 模型 ， 将 对 
动力 学 模型 的 研究 转化 到 对 动力 学 模型 所 对 应 的 微分 几何 结构 的 研究 |。 此 
Sk, RN. Smith 等 人 将 微分 几何 控制 理论 应 用 到 水 下 航行 占 中 ， 利 用 微分 几何 控 
制 理论 研 究 水 下 航行 旨 系 统 的 对 称 性 和 非 线 性 本 质 , 探讨 了 水 下 航行 器 系统 的 非 
线性 特性 ， 并 以 时 间 最 优 、 效 率 最 优 为 准则 进行 水 下 航行 莫 的 控制 菏 略 设计 ， 并 
进行 一 系列 控制 轨迹 和 航行 轨迹 的 实验 验证 |。 
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险 尔 浜 工程 大 学 办 柏 全 等 ,通过 对 洲 磺 的 动力 学 模型 进行 分 析 ， 首 次 将 基于 
做 分 儿 何 理论 的 解 厅 控制 算法 引入 到 水 下 洪 占 拥 行 控制 中 , 文中 重点 对 基于 微分 
几何 理论 的 解 粳 控 制 算法 在 浴 胡 铅 垂 而 的 运动 控制 中 的 应 用 进行 分 析 , 推 录 出 控 
制 方 程 ， 得 到 基于 微分 几何 理论 的 解 炎 控制 律 ， 并 根据 该 控制 律 对 淆 需 进 行 航 行 
操纵 仿真 ， 得 到 良好 的 控制 仿真 结果 。 西北 工业 大 学 的 秦 英 和 赵 秀 凤 等 ， 分 别 
应 用 微分 几何 相关 知识 对 人 造 工 星 控制 系统 和 飞机 榨 制 系统 进行 了 分 析 , 后 痢 运 
用 整体 化 微分 几何 理论 对 PVTOL 飞机 进行 动力 学 研究 ， 推 导出 PVTOL 飞机 动 
力学 系统 的 联络 系数 ， 得 到 其 茶 于 微分 几何 理论 的 整体 化 运动 方程 ， 指 出 该 系统 
是 可 控 可 观 的 控制 系统 ”。 





1.3 研究 目的 与 意义 


水 下 航行 苍 作 为 水 下 海洋 移动 平台 ， 在 民用 领域 ， 如 水 下 在 线 监测 、 对 水 下 
特定 目标 的 调 碍 、 勘 训 等 友 挥 大 重 要 的 作用 ， 同 时 能 够 用 于 我 国 车 事 需 求 ， 及 展 
Hse) Wa), ze TE AREA ERI EN OT FT FA o 

WARRT “OBER PUN Lv] 558 EAS EU" NI “RIK AUV 系统 设 
计 与 制造 技术 研究 ”, FE LS Be REL, 研制 出 PETREL-II 和 深水 AUV 
样机 ， 并 取得 读 题 预期 的 目标 。 在 这 两 个 诛 题 研 和 的 基础 上 ， 本 文 从 能 量 的 观点 
出 友 ， 退 过 引入 微分 几何 方法 对 水 下 航行 右 进 行 建 模 分 析 , 得 到 水 下 航行 占 基 于 
微分 几何 理论 的 动力 学 模型 , 并 以 诛 题 组 开 及 研制 的 混合 张 动 水 下 滑翔 磺 和 和 天 量 
推进 式 水 下 目 主 航行 莫 为 分 析 对 象 ， 对 几何 动力 模型 进行 具体 化 ， 退 过 仿真 分 析 
与 湖 试 海 试 试验 对 比 ,， 验证 分 析 水 下 航行 费 统 一 的 几何 动力 模型 的 正确 性 , 为 后 
续 研 究 基 于 微分 儿 何 理论 的 几何 控制 系统 提供 动力 学 几何 模型 框 淋 。 


1.4 本 文 研究 的 主要 内 容 


第 一 章 AWW. MALAK FIIT. AHK e E EST aM T HA ER A 
DLN ATRL, ARMI SLEEK PLAT a PARAR HIREA. 

PE OK PT eo FER. EH CIR] EE EH HAS JI ME, MA 
能 量 角 上 度 出 友 , E LA T UL ED) LA Be HY CB UT 8388 H1] 7J Se 
型 。 

第 三 草 USSR BYR Pa I REED AT © HO Te a BRK Pe Pa a 
的 系统 分 析 ， 得 出 其 抽象 模型 ， 并 分 析 运 动 过 程 中 所 受到 的 外 力 ， 确 定 系 统 控制 
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得 入 量 ， 代 入 水 下 航行 器 动力 学 模型 中 ， 并 对 混合 磷 动 水 下 请 暑 右 运动 特性 进行 
仿 芮 分机， 验证 了 其 动力 竺 模型 的 正确 性 和 有 效 性 。 

第 四 草 矢量 推进 水 下 目 航 行 卉 动力 学 特性 分 机。 通过 对 天 量 推进 式 水 下 目 
NLT AR BU AAT, 得 出 矢量 推进 式 水 下 目 航 行 如 的 抽象 模型 ,分 析 其 运动 过 程 
中 所 受到 的 外 力 ,确定 其 控制 输入 量 , 代入 水 下 航行 如 动 力学 模型 中 ， 并 对 天 量 
推进 陈 水 下 目 航 行 右 运 动 特性 进行 仿真 分 析 , 验证 了 其 动力 学 模型 的 正确 性 和 有 
效 性 。 

第 五 章 水 下 航行 器 湖 试 和 海 试 研究 。 本 章 给 出 了 混合 驱动 水 下 滑翔 器 整 机 
湖 斌 、 海 斌 试验 络 未 和 矢量 推进 却 水 下 目 航 行 锅 调试 、 海 试 试验 结 东 。 对 前 文 建 
立 的 通用 模型 和 仿真 结果 进行 验证 。 

BN 结论 与 展望 。 汇 总 全 文 主要 内 容 ， 所 出 今后 工作 展望 。 
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第 二 革 水 下 航行 器 动力 学 建 模 


2.1 引言 


在 水 下 航行 如 设计 和 研发 前 期 , 为 避免 大 量 的 模型 约束 实验 研究 、 预 完 信 计 
在 给 定 控制 量 出 入 情况 下 其 水 动力 特性 和 操纵 性 能 , 需要 建立 水 下 航行 右 动 力学 
模型 ， 采 用 数值 计算 仿真 的 方法 分 析 其 空间 的 动力 学 行为 、 操 纵 性 。 在 研 及 前 期 
建立 六 目 由 度 动力 学 模型 ， 通 过 仿真 方法 研究 其 动力 学 特性 , 将 各 设计 参数 对 水 
下 航行 右 动 力学 行为 的 影响 进行 量化 分 析 ， ABI RTT ae BOTT. BEAR SEIT 
= 的 [9, 46,58-61] 

本 章 从 能 量 观点 出 有 友 ， 以 微分 几何 理论 为 基础 ， 将 水 下 航行 属 视 为 三 面 对 称 
的 椭 球 体 ， 将 航行 右 所 受 的 浮力 、 午 力 以 及 航行 过 程 中 所 受到 的 的 水 动力 等 作为 
ST), 建立 其 运动 学 方程 和 动力 学 方程 , 得 到 基于 微分 几何 理论 的 水 下 航行 间 动 
力学 柑 型 ， 在 第 三 革 、 第 四 章 将 混合 驱动 水 下 清 甚 机 和 矢量 推进 式 深水 AUV $53 
型 珊 入 到 其 运动 学 和 动力 学 醒 型 中 ， 并 用 Matlab 进行 仿真 ， 验 证 建立 贷 型 的 正 
确 性 。 





2.2 水 下 航行 器 系统 描述 


2.2.1 坐标 系统 摘 述 


在 运动 学 和 动力 学 中 , 为 了 描述 刚体 在 空间 中 人 位置、 姿态 等 状态 及 运动 特性 ， 
选取 合适 的 坐标 系统 作为 参照 具有 重要 的 意义 。 一 般 而 言 ， 动 力学 系统 的 坐标 系 
选取 是 任意 的 ,本文 依据 国际 水 池 会 议 ITTC) 推荐 与 轮机 工程 学 会 (SNAME) 
术语 公报 的 体系 ， 建 立 水 下 航行 器 的 坐标 系 系统 ” 。 





2.2.1.1 地 面 坐标 系 和 航行 体 坐 标 系 


IK FE WAT at BAK on UN 2-1 tas, E- XYZ ERW Se) 为 地 面 坐标 
系 , 或 称 为 惯性 坐标 系 , 其 与 大 地 固定 连接 , “Ain AUG EPRI, E-X 
轴 可 治水 平面 水 平 指向 。 为 不 失 一 般 性 ， 将 地 面 坐 标 系 巨 -=XYZ 原点 已 选择 在 航 
tT AK Mh, E-X fa as BITA, E—Y HEREN, fH 
He [nh] LAE, E-Z HHS E-X Hh. E-Y TIAE T EN. 
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图 2-1 航行 体 坐 标 系统 描述 


WUT AAR in A, RASA is AB xyz 《标记 做 $; ) ， 其 与 水 下 航行 器 相 
对 位 置 固定 ， 并 随 水 下 航行 费 的 运动 而 运动 。 根 据 刚体 动力 学 知识 ， 动 坐标 系 的 
坐标 轴 和 原点 位 置 可 以 随意 选取 , 通常 将 航行 右 体 坐标 系 的 坐标 原 后 放 在 其 泽 心 
处 ， 如 图 2-1 所 示 。 由 于 在 航行 过 程 中 ,航行 退 泽 心 与 质心 位 置 的 相对 位 置 变化 
很 小 , 故 选 航行 融 的 泽 心 作为 航行 体 坐 标 系 的 原点 对 水 下 舱 行 融 的 运动 学 以 及 动 
力学 模型 建立 最 为 简便 。 


2.2.1.2 航行 体 速度 坐标 系 





为 了 确定 作用 在 水 下 航行 融 上 的 流体 动力 , 需要 摘 述 航行 礁 浮 心 速度 天 量 V 
与 航行 费 机 体 之 则 的 相对 位 置 天 系 。 骸 行 体 速 有 度 坐 标 系 O 一 x,y,z, “标记 做 5,) 
是 表述 水 下 航行 右 般 行 速度 矢量 与 机 体 之 间 相 互 关 系 的 坐标 系 ， 如 图 2-2 Ara. 
航行 体 速度 坐标 系 的 原 扣 0 与 航行 体 坐 标 系 原点 B 香 合 ，0O 一 x, 轴 与 豚 行 体 坐 标 
系 坐 标 原 点 实时 的 速度 天 量 重 合 ，O- 交 轴 位 于 航行 器 的 纵 问 对 称 面 内 ， 并 与 
O — x, HERTS) E75, O-z, ipi Tog O-x,. O-y, EH. 
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图 2-2 航行 体 速度 坐标 系 摘 述 


这 里 需要 确定 水 下 航行 器 浮 心 速度 同 量 凤 即 O-x 轴 与 航行 体 坐 标 系 关 系 ， 
定义 两 个 流体 动力 角 ， 如 图 2-2 所 示 。 

RE, AfA OCKA) 指 航 行 体 浮 心 处 的 航行 速度 矢量 V 与 航行 器 体 坐 标 
系 巨 - 嫉 平 面 之 间 的 夹 角 。 漂 角 按 照 右 手 定 则 规定 正 负 方 向 ， 规 定 当 浮 心 速度 天 
量 V 按照 右手 方向 绕 刀 -> 轴 正 向 旋转 至 B- xy 平面 时 ， 称 漂 角 8 为 正 ， 反 之 为 
负 ， 如 图 2-2 所 示 。 

BUSA Na ) 指 航 行 体 浮 心 处 的 速度 矢量 凤 在 航行 器 体 坐 标 系 刀 -xz 平面 
HE ce SAAT eh MH Bx ZAIRE A. TA, Be in Fe, “A 
心 速度 矢量 在 B-xy 面 的 投影 绕 B-y 轴 正 同 旋转 至 B-x 轴 时 ， 攻 角 a 为 正 ， 反 
之 为 负 ， 如 图 2-2 Ara. 








2.2.2 坐标 系统 变量 定义 


为 了 表述 水 下 航行 右 在 空间 中 的 位 置 和 姿态 , 需要 规定 描述 水 下 航行 占 航 行 
Abin ZS, 相对 于 地 面 坐 标 系 5S; 之 间 的 相对 位 置 关 系 的 参数 。 水 下 航行 器 航行 
体 坐 标 系 S$, 相对 于 地 面 坐 标 系 5S; 的 位 置 可 以 用 航行 体 坐 标 系 原 点 在 地 面 坐标 
系 中 的 坐标 (X,Y,Z) 来 确定 。 水 下 航行 器 姿态 可 用 航行 体 坐 标 系 $, 与 地 面 坐 标 系 
S. 之 间 的 三 个 欧 拉 角 oO ，9 ， 六 来 确定 。 则 水 下 航行 器 在 大 地 坐标 系 下 的 位 姿 为 
(X,Y,Z,9,0,w)。 其 中 ， 欧 拉 角 的 定义 如 下 1. 

RETR AA oO :水 下 航行 器 航行 体 坐 标 系 B 一 xz 平 面 与 地 面 坐 标 系 水 平面 E -XZ 
间 的 夹 角 ， 方 向 绕 B-X 轴 符 合 右手 定 则 ， 即 水 平面 已 -~XZ 沿 B-X 轴 依照 右手 
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TF MU eee BAT AS BB xz FT, WARE AA @ 为 正 。 

WEAN ARO: 7K FEL SLT A bn FR B — x fi 5 HT AB is ACPA E- XZ 的 
KH, TUR EZ 轴 符 合 右 手 定 则 ， 即 水 平面 E- XZ 15 B-Z i IRA Fk he 
转 至 航行 体 坐 标 系 B-x 轴 ， 则 称 俯仰 角 0 为 正 。 

偏 航 角 w : 水 下 航行 器 航行 体 坐 标 系 召 -x 轴 在 地 面 坐 标 系 水 平面 已 -~ XZ 内 
的 投影 与 轴瓦 -和 X ZINA, JympgeE-Y M eR, EUH AAT ZR 
EH E — XY i6 E — Y MAKRA FE U e dz NUT MA b KB x HH, WERL 
y AE. 

定义 描述 水 下 航行 器 运动 变量 参数 如 表 2-1 所 示 。 


R 2-1 水 下 航行 带 运 劫 变量 参数 表 





$, 系 $, f S, f 
EH HE 名 称 a " ) 
力 /力矩 ” 线 速 度 /角速度 ”位置 /姿态 角 
1 进退 Csurge) X u X 
2 潜 浮 Cheave) 7 y y 
3 侧 移 (sway) Z w Z 
4 HIIR Croll) K P 9 
5 纵 倾 (pitch) M q 0 
6 回转 (yaw) N r V 


2.2.3 水 下 航行 器 坐标 系统 转换 关系 


2.2.3.1 大 地 坐标 系 和 航行 体 坐标 系 之 间 的 转换 天 系 


研究 水 下 航行 占 的 运动 就 是 研究 其 相对 于 地 和 面 坐标 系 的 运动 , 即 研究 航行 体 
坐标 系 相 对 于 地 面 坐 标 系 的 运动 。 假 设 水 下 舱 行 融 上 的 一 个 天 量 在 航行 体 坐 标 系 
中 的 坐标 为 (x,y,z)， 在 大 地 坐标 系 中 的 分 量 为 (X,Y,Z)， 则 两 种 表达 形式 之 间 的 
JT DAYAR GA KEE I A: 


X cos(X,x) cos(X,y) cos(X,z) || x X 
Y |=| cos(Y,x) cos(Y,y) cos(Y,z) | y | 2C? | y (2-1) 
Z cos(Z,x) cos(Z,y) cos(Z,z) || z 过 

式 〈2-1) P, CÉ 表示 航行 体 坐 标 系 到 地 面 坐 标 系 的 转换 矩阵 。 
x cos(x,X) cos(x,Y) cos(x,Z) || X X 
y |=| cos(y,X) cos(y,Y) cos(y,Z) | Y 2C; Y (2-2) 
Z cos(z, X) cos(z Y) cos(z,Z2)|| Z Z 
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XX OD A, Cy 表示 地 面 坐标 系 到 航行 体 坐 标 系 的 转换 矩阵 。 
比较 式 (2-1) 和 式 (2-2) ， 方 同 余弦 窍 阵 Cs 和 Cs AAR BFE, BAT 
表示 为 ， 
CC > (233) 
根据 欧 拉 角 的 定义 可 以 得 出 ， 地 面 坐标 系 5; 可 以 通过 三 次 旋转 与 航 回 体 坐 
PAS, HA, WR 2-3 Bran. 





图 2-3 欧 拉 角 旋 转 定 义 


地 面 坐标 系 5, 转换 过 程 如 下 : 
第 一 次 ， 地 面 坐 标 系 -XYZ 绕 E-Y 轴 旋 转角 度 为 w ， 使 得 已 -X oh 
一 -外 ' 轴 ，E-Z 轴 一 E-2Z' 轴 (yw 方向 为 E- 了 轴 正 向 ) ， 旋 转 和 矩阵 为 : 




















X cosy 0 -siny || X X 
Y |=| 0 1 0 jY|-C,(v) Y (2-4) 
Z: siny 0 cosy |Z Z 





Ae — 


EWR, BRR E- XYZ RE -Z üetkfgO. ÉE-X'üh— B-x 
^, E-YthoE-Y' th COZIHZgE-Z HIER) , JEEN: 








x cos@ sing O| x’ X 
7 |=| -sing cos@ 0| Y |-C;,(0) Y (2-5) 
Z 0 0 1 || Z’ he 





"hid. SB-x Hee AR Ao, tt E-Y' Hi B-y Hh, E-Z oh 
> B-z% (@ AWA B—x HIER) , JEEN: 
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X 1 0 0 x x 
y|=|0 cosó sing | Y'|=C, (Ø) Y' (2-6) 
Z 0 -sinó cos¢]|| Z Z 
将 式 (2-4)、 式 (2-5) 和 式 (2-6) 综 合 起 来 ， 则 有 ， 
x X X 
y |=C, (¢)C,(@)C, (v) Y |-C;| Y (2-7) 
Z Z Z 


其 中 ， 
C; =C,(9)C;(A)C,(y) 
cos 0 cosy sin O —cos Ósiny 

—-|-—sinOcosy cosó-siny sing | cosÓcosó sinsin wy cos ó - cosy sin o 

sin@cosysing+sinycos@  —cosÓOsinó -sin Osin y sin ø + cosy cos o 

(2-8) 

AX (2-80 ZA AA by Ae BUTT VEA ES IRHUAETRARBIE. EE HE E AA tos PULA 
TSA Ay ZR ZF] AR PRS AR AY ASS BI AAV s s BU AT RA tip ARR] BE PRE DS 


Gs 
cosÜcosy -—sin@cosycos¢@+sinysing sin@cosysing+siny cos à 
= sin 0 cos Ó cos @ — cos Ô sin ø 
-cosĝsiny sin@sinycosg+cosysing -sin sin w sin ø + cosy cos o 


(2-9) 


2.2.3.2 航行 体 速 度 坐标 系 和 航行 体 坐标 系 之 间 变 换 关 系 


第 二 章 水 下 航行 需 动 力学 建 模 





pel 


T 


图 2-4 速度 坐标 系 和 航行 体 坐 标 系 之 间 关 系 


航行 体 坐 标 系 98 和 航行 体 速度 坐标 系 5， 


空间 中 的 相对 位 置 关系 如 图 2-4 所 
示 。 由 两 坐标 系 之 间 的 空 


zs 间 几 何 关 系 得 到 航行 体 坐 标 系 到 航行 体 速 度 坐 标 系 的 变 


BOB: 
cosa -—sina 0 
C.(a)=|sina cosa 0 (2-10) 
0 0 ] 
cosp 0 sinp 
C (8)= 0 ] 0 (2-11) 
-SO 0 cosp 
cos sing  —cosfsina sin p 
C,-C,(B)C,.(a)-| sino cos C 0 (2-12) 


—snfcosa sinfsina cosp 


2.3 7K RAT OI 5E 1 221 EE 7 


AS SCEE VB] AA ZR AB EC Be Ue Fi IS T [8] HH TEE Je PAIS EDGE PEA os is. CH TAA 
标 系 ) 的 位 姿 。 简 单 起 抑 ， 这 里 先 分 析 位 于 空间 中 无 约束 的 三 面 对 称 椭 球 体 的 运 


动 和 动力 学 表达 形式 , 骨 将 此 分 析 过 程 运用 到 温 于 理想 流体 中 的 水 下 航 
中 ， 得 到 水 下 航行 费 的 空 


MA 一 HH 


AT tis pa AY 
X IRIZN BS aA ERMAT J A EXISTE cK 


第 二 章 水 下 航行 器 动力 学 建 模 
2.3.1 空间 自由 了 刚体 运动 学 和 动力 学 表达 


空间 自由 刚体 的 坐标 系统 建立 如 上 节 所 示 。 假 设 了 =(wwwjr 和 
Q =(p,g,r) 分 别 为 刚体 线 速度 和 角速度 在 体 坐 标 系 中 的 表述 , 5 = (x,y,z) 为 网 
体 在 惯性 坐标 系 下 的 位 置 。 由 惯性 坐标 系 和 体 坐 标 系 之 间 的 变换 关系 , 刚体 在 空 
间 中 的 运动 方程 可 以 表示 为 ; 


X u 
y |-C;|v (2-13) 
Z Ww 














其 中 ，( 亏 交 纪 为 刚体 实时 速度 在 惯性 坐标 系 下 的 分 量 ，(u ww) 为 刚体 实 
时 速度 在 刚体 体 坐 标 系 下 的 分 量 ，C8 为 刚体 体 坐 标 系 到 惯性 坐标 系 的 变换 矩阵 。 

为 方便 分 析 ， 这 里 做 如 下 变量 定义 

p 和 zz 分 别 表示 在 惯性 坐标 系 下 刚体 的 动量 和 角 动 量 ,与 之 对 应 , P 和 万 分 
别 表 示 在 刚体 体 坐 标 系 下 的 刚体 的 动量 和 角 动 量 。 

在 惯性 坐标 系 下 ， 对 刚体 的 动量 和 角 动 量 分 别 求 微分 ， 即 可 得 到 | 


mW (2-14) 
i-l 
S O (2-15) 
i-l i-l 


其 中 ， 上 天 表示 刚体 受到 的 外 力 在 惯性 坐标 系 〈 世 界 坐标 系 ) 下 的 表达 ; Lx 
示 外 力 f; 作 用 在 刚体 的 位 置 在 惯性 坐标 系 下 的 表达 式 ; v; eS UMS SE RUBS P JR. 
在 惯性 坐标 系 下 的 表达 。 

根据 惯性 坐标 系 下 刚体 ( 角 ) 动量 和 体 坐 标 系 下 刚体 的 ( 角 ) 动量 之 则 的 关 
A, OH 


p-CiP (2-16) 

T -CLHI *(x,y,z) xp (2-17) 

对 式 (2-160 ~ X (2-17) 微分 ， 参 照 式 (2-14) . X (2-15) ， 可 以 得 到 : 
P=PxQ+E, (2-18) 


k 
Il =TTxQ+PxV+)> C 
i-l 





X 
[ — y 
ve 


XX (2-18) . X (2-19) 表示 在 体 坐 标 系 下 ， 刚 体 的 动量 和 和 角 动 量 的 表达 式 。 其 
中 





je: +E, (2-19) 


k 
Rb (2-20) 
i=] 
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p oC. ba (2-21) 
分 别 表 示 外 力 和 外 力矩 在 体 坐 标 系 下 的 分 量 
2.3.2 水 下 航行 器 运动 学 和 动力 学 表达 


一 般 情 况 下 ， 水 下 航行 费 为 提 融 豚 行 的 稳定 性 ， 你 证 在 受到 外 力 的 作用 下 ， 
不 发 生 倾 履 ， 航 行 秦 的 重心 略 低 于 浮 心 位 置 ， 由 航行 器 体 坐 标 系 建立 准则 ， 其 原 
EAXGTENUT i13 CM. ELA e 

EH IX RUA K FAITA Jo ob AU ESR RECN 

V.=V+Qxr, (2-22) 
2.=2 (2-23) 

KF, V =(u,v,w) 8L -(p.q.r) 分 别 为 水 下 航行 器 浮 心 处 的 线 速度 和 角 
速度 在 体 坐 标 系 中 的 表述 ，r INITA ET PAB hn BR CBI TT as HS 
心 ) 的 位 置 。 


A (2-22) 可 以 改写 为 : 
Ve =V +0 xr 


(2-24) 
=[ -êv at] 
由 动能 表达 式 ， 航 行 器 航行 过 程 中 的 动能 
7 S (mL, V, 201,9 (2-25) 


整理 可 得 ， 水 下 航行 器 的 动能 表达 式 为 ， 


/ml 
na) (mee he 228 
mr Q 


其 中 为 航行 器 的 总 质量 ， 工 为 3x3 Misa J, FIAT d FAT HAL b HB AN 
TU 
这 里 和 表示 矢 量 的 又 乘 运 算 ， 对 于 向 量 x= (xxx) ， 


0 -x; x 
X=| x, 0 -x, (2-27) 
— x 0 
对 于 向 量 y=(y,,y, 六) > WA: 
0 =x x)» 
xy=| x, 0 =x || y, |=xxy (2-28) 


且 具 有 性 质 : 
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[s] = (2-29) 
根据 Kirchhoff 7; Ez", 7k FANIT 888] E] Zo P B SN RE EIA S 
(VV (M, C,\(V 
; EN en (2-30) 
xo) (ef ole) 


其 中 M 为 附加 质量 ，. 为 附加 转动 惯量 ，C , 为 附加 质量 和 附加 转动 惯量 
的 交叉 项 ,， 即 附加 静 矩 ， 上 述 三 项 的 系数 取决 于 周围 流体 的 密度 和 航行 体 的 几何 


形状 。 
综 上 可 以 得 到 ， 水 下 航行 右 在 流体 中 运动 的 忌 的 动能 表达 式 沧 阵 形 式 为 : 
r.A(V) pu SE (2-31) 
210) UI; IL, 
II. II ml,-M, -mf +C 
其 贡 量 11 I| is T CG f 
中 质量 矩阵 Re <4 pra J+J; | 
XX (2-31) 也 可 以 写成 癌 量 形式 : 
f =(V "I 十 2V 11,0 -Q'IDQ) (2:32) 
由 动能 和 动量 的 关系 ， 妈 
pa (2-33) 
oV 
NN (2-34) 
KP} 
FY EAS SUZK RATT S8 JJ] GRUT SI CE VISA HBR EIA SL: 
P) {m+M, -mF,+C,' \(V MS 
IT) \mf.,+C," — J,+J, Q 


Xx FUR dS AP ABC, AEK PLAT di A REAT fn] HOA RE 

TK TR BLUT 8303 — ATER ER HUI, SUA EERE J, BA EERE M , 
ARN BAY OH Tie TEXR ER J , 为 对 角 和 矩阵 ， 即 附件 质量 窍 阵 非 对 角 上 的 元 和 聂 为 0。 

水 下 航行 右 的 质心 相对 于 体 坐 标 系 的 坐标 ri 很 小 ， 在 质量 矩阵 中 可 以 忽略 
不 计 , 如 Chyba 相关 论文 中 体 坐 标 系 原点 选 在 航行 体 的 泽 心 处 , 而 泽 心 和 质心 重 
fr, Wig AO, Blo mr, 为 零 窍 阵 。 航行 体 坐 标 系 原点 位 于 水 下 航行 妖 的 浮 心 ( 几 
何 中 心 ) ， 针 对 水 下 航行 如 的 质心 相对 于 体 坐 标 系 的 坐标 ros。 7K PEUT a 
和 质心 间距 较 小 ， 建 并 模型 时 可 以 忽略 不 计 ， 水 下 航行 右 质 量 均 布 ， 不 考虑 在 姿 
态 调 节 时 而 引起 的 转动 惯量 变化 ， 以 及 对 质量 矩阵 的 影响。 

由 以 上 假设 则 将 式 (2-350. 简化 得 到 ， 


P ml;+M , 0 V 
= (2-36) 
II 0 J,*J, AQ 
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WM-ml^«-M,. J-J,*J,: M 和 J 为 对 角 阵 ; 则 由 刚体 动量 和 和 角 动 量 
方程 : 


P - (ml, +M V - MV (0:37 
I -,-J,)2-J0 (2-38) 
以 及 参照 式 (2-18) . 5X (2-19) 可 以 得 到 ， 
MV = MVx Q«E, (2-39) 
JQO=JQxQ+MVxV «Y. C;|Ll-| y || |xC; f, E, (2-40) 
i-i 
"d 





其 中 MVxQ，JQ2xQ MMV xy 表示 科 氏 加 速度 和 同心 加 速度 。 式 (2-39) 、 
XX (2-400 为 水 下 航行 器 运动 学 方程 和 动力 学 方程 。 

这 里 可 以 将 科 氏 加 速度 和 向 心 加 速度 由 微分 几何 理论 通过 映射 来 表达 中 1 
科 氏 加 速度 和 向 心 加 速度 由 水 下 航行 器 运动 而 产生 的 , 由 于 水 下 航行 器 的 质量 甜 
阵 、 惯 性 矩阵 、 附 加 质量 窍 阵 以 及 附加 惯性 矩阵 等 的 存在 ， 会 产生 相对 应 的 力 
GE) 。 此 力 〈 和 矩 ) 不 可 以 通过 外 界 的 控制 输入 量 控制 。 故 这 里 将 科 氏 加 速度 和 
问心 加 速度 与 线性 的 〈 角 ) 加 速度 做 统一 处 理 。 


将 式 〈2-39) 、 式 〈2-40) 改写 成 : 
V+M '(QxMV)-M E, (2-41) 


i-l 


" X 
Q-J'(QxJ3)-J (VxMV)-J | 5C; 2H xC; f, +E, 
Z 


(2-42) 
2.3.3 ZK FARITAJ IK 


BU AUT J LEE Ve TE LAs ACHT UT. FR —5EBUNLH]. SE BUI TE 
为 一 个 微分 几何 概念 在 机 械 系 统 中 有 很 多 应 用 。 机 械 系 统 的 动力 学 问题 可 以 
用 微分 几何 中 的 黎 受 流 形 概念 表述 。 比 如 ， 机 械 系 统 中 的 惯量 窍 阵 可 以 看 作 歼 受 
度量 ， 则 动力 学 中 的 拉 格 明 日 方程 可 以 雪 示 为 微分 几何 形 却 。 访 动力 学 方程 的 解 
表示 成 黎 曼 法 形 上 的 测 地 线 ( 测 地 线 是 曲面 上 最 短 的 一 条 曲线 )。 在 机 械 系 统 中 引 | 
进 控 制 量 ， 束 变 为 控制 系统 问题 。 这 种 控制 系统 问题 可 以 转换 为 歼 曼 流 形 问 题 ， 
即 微分 儿 何 控制 问题 。 


WAR SE BERE: c-| ) 其 中 M=mD +M,,， J=J,+J;; G、M 和 


J 为 对 角 阵 ; 
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絮 曼 度量 唯一 确定 了 一 个 仿 形 上 映射， 关联 的 是 它 的 Levi-Civita 联络 。 
Levi-Civita 联络 提供 了 在 配置 空间 G 中 关于 曲线 的 加 速度 概念 , 其 意义 是 剑 证 了 
加 速度 实际 是 沿 曲 线 y() 的 一 个 切 向 量 场 方向 1。 

构造: 

y(t)=(b(t),R(t)) (2-43) 

X (2-43) 表示 在 SE) CH SE(3)=SO(3)x#?, ， 此 式 用 笛 卡 尔 积 表明 
三 维 空间 中 的 旋转 群 和 位 置 组 成 的 有 序 实数 对 唯一 确定 欧 几 里 得 群 SE(3) 的 6 维 
ERZO 中 的 一 条 曲线 。 其 中 5b(?) 和 R(?) 分 别 表示 水 下 航行 器 在 地 面 坐 标 系 下 
的 位 置 向 量 随 时 间 变 化 曲线 和 姿态 向 量 随 时 间 变 化 曲线 。 

对 云 〈2-43) 求 取 时 间 的 叶 数 ， 得 到 配置 空间 G FAR yO 的 速度 表达 ， 





y' (t) «(V (t).42(t)) (2-44) 
进而 可 以 得 到 配置 空间 G 中 曲线 yO 的 加 速度 表达 ， 
| | V+M'(QxMV) | 
Viva}. (2-45) 
f Q+J (QxJ42*V xMV) 


Reb voy! 表示 列 维 - 奇 维 塔 映射 Vy' 表 示 y' 关于 自身 的 协 变 微分 , 是 几何 
加 速度 。 
进而 得 到 水 下 航行 器 的 动力 学 方程 微分 几何 表达 形式 


vw | V*M'(QxMY) E 
"7 QJ (QxJQ«VxMV)]. 





M E, 
1 Oxc: (x, -b))xCE f, - Ej) 
(2-46) 
XX (1-44) ZEHA ZK PUT ais LR ERAS HH P FRO A 7J3B se P], nn 


V «M '(QxMV) 
ea s (2-47) 
+J (QxJQ+VxMV) 


FOIA AG EE. FANE BE. BEPC HERE. TD ERE ACAI, ROE SLIT a BR 
统 的 目 身 有 有关， 外 界 控制 量 不 能 干预 。 
M E, 
(2-48) 


vor = J^ È (CE (x, -9)) «6. f, E) 


y 





RIAK PUT te SPF AA E, 包括 力 和 力 窍 相关 联 项 ， 其 中 又 分 为 可 控 量 
和 不 可 控 量 。 可 控 量 是 指 在 水 下 逢 行 豆 与 外 界 天 联 的 力 〈 窍 ) 中， 可 以 通过 控制 
REET] CHE) 从 而 达到 改变 航行 辫 运 动 状态 的 目的 的 变量 ; 不可 控 量 是 指 不 能 通 
Pa ral HE] CHE) 从 而 达到 改变 航行 费 运 动 状态 的 目的 的 变量 。 
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HEIL TAK PUT at HSS I PAT» PEUT i TSS Ah E) 按照 可 控 量 和 不 
可 控 量 分 类 ,可 以 将 上 式 (2-48) PLAT aR AT SSH RAAE, RAER (2-48) 
中 


可 得 : 
vr -| MOUE) | (2-49) 
J (CD(Ur)+7Teox +T) 
Hip. FQ. T, Ao Hy Bee TEA A 
进一步 ， 对 式 〈2-44) 改写 ， 得 到 水 下 航行 器 的 几何 动力 学 方程 : 
-| M "(D(f)-F,) | 


J ’(D(t)+rogxF; +T,,) 


K M KE (2-50) 


J’ (D(t)+ree xF) VJ T, 


Y (7(D) Xe; (v(t) 6,(t)) 


Y (7(D) -| uius. | (2-51) 


J QO(r)*ra;xF,) 


V 
4 
zB 


(2-52) 


S67 (0)s00)-| 


i=l 


M F, 
re 
G; 表示 黎 曼 度量 G 的 道 G- WHET, 8L (1) 表 示 可 控制 输入 量 (R，T,) 的 名 个 


Wg-(xyzo,0,v) 表示 水 下 航行 器 在 地 面 坐标 系 下 的 位 置 和 姿态 ， 
Y=(7, 9) 表示 航行 器 在 空间 中 的 位 姿 以 及 位 姿 的 变化 ，x(0) 和 x(T) 表 示 航 
TJ 句 的 初始 状态 和 最 终 状 态 。 则 水 下 航行 妖 的 运动 学 和 动力 学 方程 可 以 表述 为 : 


ji 


6 
x (t) Y, (x(0)* LY (2)5, (1) (2-53) 
其 中 党 移 量 ， 
C;V 
ON ( 
T7 M"| MVxQ+D(f)| xd 


J'|JQxQ«- MVxV «D(r)*raxF, | 


Y, -(0.0,G7) ，6 (r) 为 控制 输入 量 。@ 表示 水 下 航行 器 相对 于 惯性 坐标 系 的 姿 
ASIA y+ ，9 和 9 三 个 欧 拉 角 的 旋转 角速度 与 在 航行 体 坐 标 系 下 的 航行 体 旋转 角 速 
度 p，gq 和 /三 个 分 量 之 间 的 变换 关系 。 
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] -cosgtan@ +singtan@ 





0-0 sin COSO (2-55) 
0 COS Q _ sing 
cos 0 cos Q 


2.4 本 和 草 小 结 


本 革 退 过 建立 水 下 航行 如 坐 标 系 统 , 由 空间 任意 刚体 受 力 、 运 动 分 析 为 起 扩 ， 
针对 水 下 航行 占 所 处 的 水 介质 环境 ， 从 能 量 的 角度 出 友 , 推导 出 水 下 航行 如 的 动 
力学 方程 ,并 通过 引入 柳 曼 度量 ,将 水 下 航行 间 的 动力 学 方程 进行 几何 推导 ,得 
到 水 下 航行 莫 的 几何 动力 竺 方程 统一 形式 。 
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第 三 重 混合 驱动 水 下 滑翔 兹 动力 学 特性 分 析 


Boe EARRAK Nao IS lta at 


3.15/15 


AS St DAR eZ Sec UE AE SRK Pia eas CPETREL-ID 平台 为 研究 对 
象 ， 利 用 第 二 章 推 导出 的 水 下 航行 器 几何 动力 学 模型 统一 形式 ， 运 用 Matlab fi 
真 分 析 PETREL-I 的 动力 学 行为 特性 .首先 介 绍 混合 驱动 水 下 请 翔 机 PETREL-II 
系统 模型 ， 对 其 系统 构成 和 布局 进行 分 析 , 在 第 二 章 研究 的 基础 上 对 混合 请 翔 规 
模型 进行 简化 ， 得 到 PETREL-I 的 几何 动力 学 模型 ， 分 别 完成 混合 驱动 水 下 清 
翔 峰 在 浮力 驱动 模式 和 浮力 -螺旋 桨 混合 驱动 模式 下 铅 垂 面 、 空 间 螺 旋 运 动 的 仿 
真 ， 分 析 预 测 PETREL-I 各 种 工作 模式 下 的 运动 特性 ， 为 PETREL-I 的 设计 过 
程 、 湖 试 和 海 试 试验 提供 帮助 。 


3.2 EARRAK MRAR ARAIRE NAN 


混合 驱动 水 下 滑翔 器 PETREL-I 是 在 PETREL-I 研 究 的 基础 上 设计 开发 的 第 
二 代 混 合 驱 动 水 下 滑翔 右 , 和 它 集 成 了 螺旋 桨 驱动 模式 和 浮力 驱动 模式 ， 属 于 一 种 
新 型 水 下 机 左 人 系统 。PETREL-I ZI] Ju E ELE Su ASK PTS FEL TEL LTE 
时 间 长 、 这 航 范 围 广 、 噪 音 小 、 成 本 低 、 环 保 、 易 操作 的 优点 ， 又 兼 有 传统 水 下 
目 主 山行 器 的 机 动 性 高 、 航 行 速度 快 、 运 动 精 上 度 高 等 特点 。 

PETREL-I 的 主要 性 能 指标 为 : 

d) 最 大 工作 深 谋 为 1500m ; 

(2) 最 大 航程 不 小 于 1500km; 

(3) BATH PUTER 1knot ; 

(4) ”最 大 水 平 推进 航速 1.5m/s 。 


3.2.1 混合 驱动 水 下 滑翔 器 系统 构成 与 布局 








PETREL-I 机 体 由 五 部 分 构成 ,浸水 舱 和 密封 舱 相 结合 的 方式 ， 主 要 包括 头 
部 导 流 日 、 前 舱 、 中 舱 、 后 舱 、 尾 部 淫水 舱 等 组 成 。 滑 翔 器 机 体内 部 按照 由 前 到 
后 分 布 有 浮力 驱动 单元 、 姿 态 调节 单元 、 控 制 传 感 单元 、 螺 旋 桨 驱动 单元 等 。) 
滑翔 机 滑翔 时 提供 升力 的 滑翔 机 缀 通 过 机 中 固 定 槽 安装 在 后 舱 密 封 膏 体 的 两 侧 ， 
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滑翔 机 囊 通 过 固定 槽 内 的 调节 孔 对 机 辟 的 位 置 进 行 微 调 ， 以 得 到 更 好 的 效果 。 尾 
Hi MUZIK Ae ER ZA CTD 传 感 占 ， 般 内 有 压力 传 感 右 ， 乓 部 安装 有 局 度 计 传 感 
器 ， 螺 旋 桨 驱动 单元 位 于 尾部 敞 水 舱 尾 部 。PETREL-I 整体 结构 布局 如 图 3-1 和 
图 3-2 所 示 。 











Fé HB in KA 


图 3-1 PETREL-II 滑翔 器 机 体 三 维 图 


CTD f£ gk gs 


天 线 


螺旋 桨 张 动 单元 
抛 载 模块 
控制 传 感 单元 


图 3-2 PETREL-II 滑翔 器 系统 布局 


混合 驱动 水 下 滑翔 机 PETREL-H 系统 中 ， 参 与 运动 控制 调节 相关 的 系统 主 
要 包括 : 浮力 驱动 单元 、 姿 态 调 太 单 元 、 螺 放 桨 驱动 单元 。 浮 力 驳 动 单 元 分 为 外 
皮 台 和 内 皮 上 时, 分 别 位 于 滞 开 式 的 头 部 导 流 单 和 和 密 财 的 前 舱 中 。 浮力 驱动 单元 的 
通过 调 市 外 皮 守 和 内 皮 早 之 间 的 液压 油 的 体积 , 达到 调节 水 下 滑翔 机 整体 体积 的 
目的 ， 改 变 机 体 所 受到 的 浮力 的 大 小 ,利用 疤 浮 力 产 生 驱 动力 。 姿 态 调节 单元 位 
于 背 翔 机 的 中 舱 ， 通 过 对 偏心 重 物 沿 B-x 轴 前 后 移动 和 绕 B-x 轴 的 转动 造成 背 
翔 器 重心 的 位 置 改变 ,而 重心 调节 的 同时 ,滑翔 机 浮 心 位 置 相 对 不 变 ， 重心 和 浮 
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心 之 间 产 生 一 个 转 朱 ， 使 得 涓 翔 机 绕 B-z 轴 和 绕 B-x 转 动 。 重 力 和 浮力 产生 的 
转 矩 和 滑翔 机 机 体 所 受 水 动力 相互 作用 , 滑翔 机 实现 俯仰 和 转 回 的 运动 。 螺 旋 桨 
驱动 单元 位 于 滑翔 机 尾部 属 水 舱 的 后 部 ， 在 螺旋 染 推 进 作 用 下 配合 姿态 调节 单 
元 、 浮 力 驱动 系统 ，PETREL-II 实现 快速 机 动 性 。 


3.2.2 混合 驱动 水 下 滑翔 器 系统 抽象 模型 


如 图 3-3 Pron, 根据 各 舱 段 的 作用 ,这 里 可 以 将 PETREL-I 抽象 成 一 个 简单 
的 运动 系统 ， 该 运动 系统 由 变 浮 力 刚体 、 偏 心 姿态 调节 刚体 、 滑 翔 器 刚体 (包括 
滑翔 器 壳 体 、 滑 翔 机 囊 、 压 仓 刚体 和 螺旋 桨 驱动 单元 等 ) 构成 。 滑 翔 器 刚体 与 外 
界 流体 相互 接触 , 是 一 个 在 流体 介质 中 浮动 的 具有 六 自由 上 度 的 刚体 , 滑翔 机 入 水 
时 ， 滑翔机 的 姿态 水 平 ， 无 横 滚 、 俯 仰角 度 ， 记 此 时 的 变 浮力 调节 装置 的 浮力 调 
节 值 为 零 ， 姿态 调节 偏心 重 物 转动 角度 为 零 ， 平移 距 离 为 零 ， 此 状态 记 为 滑 甚 机 
的 初始 状态 。 

模型 中 各 个 参数 定义 为 : 参数 1 表示 变 泽 力 刚体 沿 滑翔 机 机 体 坐 标 系 刀 -zx 
轴 到 航行 体 浮 心 处 的 距离 ;参数 A 表示 变 浮 力 刚体 相对 于 初始 状态 产生 的 浮力 
调 市 量 ， 当 变 浮 力 刚 体 产 生 的 浮力 大 于 和 零 时 记 为 正 ， 反 之 为 负 ， 参 数 1, 表示 姿 
人 态 调 市 偏心 重 物质 心 距 滑 翔 机 机 体 坐 标 系 B-x 轴 的 距离 ， 参 数 6 表示 姿态 调 市 
偏心 重 物 绕 滑 翔 机 机 体 坐 标 系 Bx 轴 转 动 的 角度 ， 在 滑翔 机 机 体 坐 标 系 中 沿 
B 一 x 方 同 , 从 后 往 前 看 , 姿态 调节 偏心 重 物 道 时 针 旋 转 为 整 , 反之 为 负 ; BRL, 
表示 在 滑翔 机 的 初始 状态 下 ， 姿 态 调节 偏心 重 物质 心 沿 滑 翔 机 机 体 坐 标 系 B — x 
轴 距 浮 心 处 的 距离 ， 参 数 Al, 表示 姿态 调节 偏心 重 物质 心 沿 滑翔 机 机 体 坐 标 系 
B 一 x 轴 相 对 于 初始 状态 平移 的 距离 ， 偏 心 调 节 重 物 沿 B-x 方 向 移动 为 正 ， 反 之 
为 负 。 





图 3-3 混合 张 动 水 下 滑翔 郁 系 统 抽象 模型 
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3.2.3 i& AIk NRI RS AS fe) 14. 


混合 驱动 水 下 清 翔 机 在 序 力 略微 调节 的 状态 下 进行 工作 , SD ad Te ob A E 
心 相 对 位 置 的 变化 , 使 得 滑翔 机 机 体 在 海水 中 倾 糙 , 产生 一 定 的 俯仰 或 横 滚 角度 ， 
并 通过 两 侧 的 水 平 请 翔 层 利用 与 水 相互 作用 产生 的 升力 , 在 铬 垂 面 运动 的 同时 并 
产生 癌 击 或 侧 背 的 运动 分 量 ， 实现 同 前 滑行 或 转 灾 的 工作 状态 。 这 里 将 混合 驱动 
水 下 滑翔 机 进行 以 下 合理 的 抽象 : 

(1) 因 溯 力 驱动 日 元 引起 的 浮 心 位 置 变化 即 浮 力 调 市 液压 油 在 内 、 外 油 完 
之 间 的 变化 而 引起 的 质心 变化 忽略 不 计 。 即 浮力 调节 单元 仅 提供 相应 的 额外 浮力 
KRAMAS NE JIRE: 

(2) ZRH RSA pes ANE RS UH AE V EFE P fii 
调节 重 物 所 产生 的 速度 和 加 速度 ， 则 姿态 调节 单元 产生 的 学 心 和 重心 相对 位 置 变 
化 可 以 简化 为 : 在 质心 与 浮 心 相 对 位 置 不 改变 的 情况 下 , 消 甚 机 机 体 受 到 沿 背 著 
BUD LM A ZR B — x HEX B — y HI BLU PEERS e 





.3 EG UB JIZK. Naw Shee ew 


3.3.1 混合 驱动 水 下 滑翔 器 受 力 分 析 


依据 3.2 节 中 PETREL-H 系统 的 简化 模型 ， PETREL-II 受 力主 要 为 重力 、 译 
力 、 流 体 动 力 〈 和 包括 惯 性 流体 动力 和 粘性 流体 动力 ) 和 其 他 外 力 。 其 中 ， 其 他 外 
力 为 混合 驱动 水 下 背 翔 机 模型 简化 后 得 到 的 附加 外 力 〈 和 窍 ): 额外 浮力 、 额 外 序 
力 怎 、 额 外 模 谱 力 宅 、 额 外 俯仰 力矩 和 螺旋 桨 推力 〈 和 矩 )。 


3.3.1.1 流体 动力 : 惯性 流体 动力 和 粘性 流体 动力 


当 PETREL-II 在 流体 介质 运动 时 ， 由 于 滑翔 器 机 体 与 周围 流体 介质 相互 作 
FA, 滑翔 器 在 水 中 实现 相应 的 运动 。 在 滑翔 器 运动 的 同时 势必 会 带动 一 部 分 的 流 
体 随 滑翔 器 机 体 运 动 。 因 此 ， 流 体 介 质 和 滑翔 器 机 体 之 间 必 然 存 在 作用 力矩) 
和 反作用 力 〈 和 矩 )。 作 用 在 滑翔 器 机 体 上 的 流体 动力 ， 除 了 与 机 体 本 身 的 几何 参 
BARI, AA ESB. VAST AREA 

对 于 PETREL-II， 其 运动 参数 主要 包括 滑翔 器 运动 的 攻 角 、 漂 角 、 速 度 、 角 
速度 、 加 速度 和 角 加 速度 。 滑 翔 机 所 受 的 流体 动力 根据 其 产生 的 原因 不 同 ， 可 以 
分 为 惯性 流体 动力 和 粘性 流体 动力 。 在 不 考虑 惯性 流体 动力 和 粘性 流体 动力 之 间 
相互 粳 合 作用 的 情况 下 ， 人 惯性 流体 动力 与 滑翔 机 运动 的 加 速度 和 角 加 速度 有 关 ， 
粘性 流体 动力 与 滑翔 机 的 攻 角 、 漂 角 、 速 度 和 角速度 有 关 。 
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惯性 流体 动力 由 于 是 混合 驱动 水 下 滑翔 器 在 流体 介质 中 作 非 定常 运动 时 , 由 
于 流体 介质 的 惯性 以 及 滑翔 器 机 体 在 流体 内 运动 使 得 滑翔 器 机 体 周围 的 波动 声 
的 速度 分 布 发 生 改 变 , 进而 引起 的 附加 质量 效应 的 。 依 据 流体 力学 中 的 势 流 理论 ， 
惯性 流体 动力 可 以 看 做 附加 质量 产生 的 力矩 阵 ， 即 
T, =-M,V (3-1) 
RH, n-[X, Y, Z, K, M, N 下 ,表示 沿 三 个 坐标 轴 产 生 的 力 和 力矩 
M ,为 6x6 的 附加 质量 矩阵 。 
混合 驱动 水 下 滑翔 机 运动 过 程 中 所 带动 的 周围 流体 的 动能 可 以 用 滑翔 器 消 
耗 的 这 部 分 能 量 来 表示 ， 则 流体 的 动能 可 以 表达 为 ; 


人 e cf (3-2) 
"^ z(a) lc J, je 


PAY TOT Joi EKE RE M ee TO SD IE iE AE, FRR ESTE ZIRT w PRO 
MEMS mhBAR, MESSEMNBWROCK. PAD SEM MA 
6x6 的 对 称 窍 阵 ， 即 





Ai Ay Ms Aa As Ae 
hs An da Aua As "ag 
M, = be E - As As Ass Asi Ass As (325) 
C, J f Au Aay Aog Ay Aas "ag 
Ais Aos As Ays Ass As 


Ze dae due Mee Ae 

An. PRU A, NIT IAL, DA ie CHO 加 速度 运动 时 ， 产 生 治 j 方 
YAN Die EE CBA PA. BRP Fe SU EO. BI AL cE ATT ISTE i 
SP PAAR CAD) WTR SEX IY PAESE BUTE AS 77 PAIN te A, EE, 
同时 规定 : Vox. y. ZT 1. 2. 3 表示 ; Sex. y. zm] 4、 
Ss ORIA Us 

对 于 本 文 研究 的 混合 张 动 水 下 滑翔 项 ， 参 照 2.2 BELTER, ÓE 
设 滑翔 机 机 体 近 似 看 作 三 轴 对 称 的 椭 球 体 , 则 附加 质量 年 阵 可 以 得 到 简化 ， 仅 剩 
矩阵 主 对 角 线 上 的 附加 质量 ™， 即 





N 


(3-4) 


c ccc 
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O -O O O OQ 


© 
© 
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时 ， 沿 沅 动 方 回 作 用 在 滑 翩 机 机 体 上 的 力 。 烙 性 流体 动力 是 水 下 舱 行 颖 受到 的 最 
复杂 的 一 部 分 力 ， 主 要 由 层 流 边界 层 的 线性 摩 探 、 汪 激 边界 层 的 二 次 摩 探 和 涡流 
造成 的 二 次 阻力 组 成 P009, 

对 于 外 形 确定 的 、 处 于 凑 止 的 无 限 水 域 中 的 运动 的 鱼雷 ， 名 略 舱 速 的 影响 ， 
则 粘性 流体 动力 可 以 表述 为 : 

(DE), D(t)) = f (a. B.V... p.4,1,6,,0,,6, ) (3-5) 
GATT PRIN A. DUIS. EE, FARR RE AINE AK. 

XI T AS SCT FEY TR KKB YR PALE SR e SR TEE ER, 其 航行 姿态 依靠 
Zu Vl, FE EEE RR ER ACLS, WoT RG oko PIRTHPL 
HD ira THE ZK ZJ SE AME nC BIC EF EA EON O EFI, SRI 
以 下 的 表达 式 : 

fæ, B: Vr p.q.r) v Lf fo f a, fs Jol = 


] a / ry ! ar ! / 
5 ^V (C, (0) + CH le|- C? BN +q + Chr - Car! +c Bq’) 








T 


r'|+ 


1 : d 
5 V; SC, (0) - Cat C;r' € C? a| + C?" aa |-- C7 
Cy r|r' + CE" lo|r' - C?^ alp + CP" Blr’) 
1 ! / / 
FPVIS(CLB + Cz p + Cia! + C7" B|B| + C7" qq + C7" |e 
+ C4 glg'| .- Ci"? lal B c?" lo 
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l 

— pV; SL(C? B + C} p' + Cía! + C?" BB+ C?" qq' + C?" |B 
p On Sat poer lox B + e" lo 
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— pV; SL(C B+C} p' + Coq! +C" B|B|- Cd qq' + CH |B|g' 






































"e C^4g q'|+ cial la| B+ Cu la q’) 
* pV2SL(C, (0) + Cz + Cur + C la + CHala] CD Jr 
CT, r' mek alr' + Cs^ || C" Br) ( 3-6) 
HE UK PB POOL AT SS BE PE ZK JIA: 
DODI SU d (3-7) 


3.3.1.2 重力 、 浮 力 以 及 扶正 力矩 


混合 驱动 水 下 滑翔 机 在 航行 初始 状态 为 中 性 ， 即 其 重力 和 受到 的 浮力 相 平 
衡 。 由 于 重心 和 浮 心 的 不 重合 , 会 产生 相应 的 扶正 力矩 ， 如 图 3-4 和 图 3-5 所 示 。 
重力 和 浮力 在 航行 体 坐 标 系 下 的 表示 分 别 为 ; 
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0 -sin 0 

F, =C; | -G|=G| —cos@cos¢ (3-8) 
0 cos Ô sin @ 
0 -sin 0 

F, =C, | B,, |=B,,| —cos0cosó (3-9) 
0 cos Ô sin ø 


依 第 二 章 坐 标 系 统 的 描述 , AIRAS MEEK ER alae aD iL A 
航行 体 坐 标 系 的 原点 ， 故 浮 心 对 航行 体 坐 标 系 的 原点 力矩 为 0， 重心 位 于 航行 体 
坐标 系 中 的 re = (0,-lec 0) ， 则 重力 对 航行 体 坐 标 系 坐 标 原 点 的 力矩 在 航行 体 坐 
标 系 下 的 各 个 分 量 为 : 


0 -sin O cos Ó cos à 
Tog = Fog X Fo =G] -leg |x| —cos@cos ¢ | = -Glec 0 (3-10) 
0 cos Osing sin 0 





yG 
图 3-5 PETREL-I 扶正 力矩 分 析 b) 
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第 三 重 混合 驱动 水 下 滑翔 融 动 力学 特性 分 析 


3.3.1.3 额外 负 浮 力 及 负 浮 力矩 


由 图 3-3 所 示 ， 由 于 浮力 驱动 系统 中 内 外 油 暑 之 间 油 量 的 变化 ， 产 生 的 相应 
的 序 力 变化 ， 即 额外 负 浮 力 AB ， 在 地 面 坐标 系 中 ， AB =ABY ， 根 据 地 面 坐 标 
系 到 航行 体 坐 标 系 的 转换 窍 阵 ， 有 
0 
AB =C,| AB|=(ABsin@ ABcos0cosó -AB cosÓsin ø) (3-11) 
0 
在 航行 体 坐 标 系 中 , 额外 负 浮 力作 用 中 心 与 航行 体 坐 标 系 之 间 的 位 置 关系 为 
Rs =(1。 0 0) ， 则 有 浮力 变化 引起 的 额外 负 浮力 矩 为 ， 
Ms=RsxAB=(0 ABl,cosÓsinó/2 ABl,cos0cosó/2) | (3-12) 
PETREL-I HY? J SRSA ERT TE FH LT E Bh TAE 7JRUSUT TATE 7J AG 
做 : 
(AB,M,,) = 
AB sin 0, AB cos 0 cos à, —^B cos Osin g, i (3-13) 
0, ABI, cos Ô sin 9 / 2, ABI, cos 0cos @/ 2 


3.3.1.4 SWINE 7J XB ERA NER 7JÀB 


如 图 3-3 所 示 ， 当 姿态 调节 控制 系统 使 姿态 调 蔬 重 物 移动 距离 A 时, 急 略 调 
“Hd ED EST UAT se A A BY GRRE), 由 于 混合 张 动 水 下 滑翔 机 整体 重力 不 
变 ， 相 当 于 在 其 上 加 了 一 个 额外 力 窍 M, = RoG, ， 其 中 姿态 调节 重 物 重 力 和 
移动 距离 在 航行 体 坐 标 系 下 的 表达 为 ， 
0 
G, =C}|-G, |=(-G,sin@ -G,cos0cosó G,cos@sing) (3-14) 
0 





R,, =(Al, 0 0) (3-15) 

则 和 额外 俯仰 力矩 ， 
M,,, =R,,,xG,, =G,, (0 —Al, cos Ô sin ø -Al, cos cos ø) (3-16) 
当 姿 态 调节 控制 系统 使 姿态 调节 重 物 绕 航 行 体 纵 轴 旋转 角度 5 时， 如 图 3-6 
所 示 ， 忽略 姿态 调节 重 物 绕 航 行 体 纵 轴 转动 角速度 的 影响 ， 产生 的 额外 横 深 力 完 
M 在 体 坐 标 系 中 总 是 延 Bx 轴 方 向 ， 治 Bx 轴 方 向 看 ， 姿 态 调节 重 物 逆 时 针 旋 转 

"Es 

M,-(Gl,snó 0 0) (3-17) 
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第 三 重 混合 张 动 水 下 滑翔 右 动 力学 特性 分 析 








图 3-6 混合 驱动 水 下 滑翔 机 姿态 调 市 重 物 模 深 调节 示意 图 
1. 调 节 重 物 转 动 轴 2. 调 市 从 动 届 形 齿轮 3. 调 节 主 动 耸 轮 4. 姿 态 调 市 电池 包 





PETREL-II 的 姿态 调节 系统 对 滑翔 机 的 额外 侨 仰 力 窍 及 额外 横 深 力 窍 记 做 : 


0 0 0 
0 0 0 
RMAME € Heal o 
M, M,, | M, 0 Grlr sin ô Grlr sin ô 
—AIP cos Ô sin @ 0 —AIP cos O sin @ 
—AIP cos 0 cos à 0 —AIP cos 0 cos à 
(3-18) 


3.3.1.5 PEERS TE 7J AUS AB 


PETREL-II HY) 8 WE sam HY HE 7J CE W IT s AIA bs 28 UB ex ze d8 IH] B — x H8 75 Iul, 
F,-(r 0 0), REDERE B-x*i AZ. M,-(-M, 0 0), HIT 
旋 桨 奖 叶 转动 时 所 产生 的 推力 和 转 窍 非 线 性 特性 明显 ， 在 实际 计算 中 进行 简化 ， 
可 以 由 敞 水池 实验 获得 其 性 能 指标 。 其 推力 和 转 窍 可 表示 为 ， 


2 
T= K pd (3-19) 
2 
M,=K, en =| (3-20) 


式 (3-19) FI (3-200 P: o 一 水 的 密度 ; n — BRE (r/min); DD 一 
螺旋 桨 直径 ; K, 一 推力 系数 ; Ko — AER. 其 中 螺旋 桨 推力 系数 Kj RUBER RR 
数 K 可 由 敞 水 试验 测 得 。 

PETREL-I 推进 器 对 滑翔 机 的 作用 力 记 为 : 

(F;,M;) -(T,0,0,-M,,0,0) (3-21) 
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第 三 革 混合 张 动 水 下 滑翔 胡 动 力学 特性 分 析 


3.4 GUN zJIZK N78 E RR 35 271 73 T 


通过 上 节 中 对 PETREL-I 78 POOL Se 7J2) 9r, RT Dae Beas (2-54) 中 
所 建立 的 统一 的 水 下 航行 器 动力 学 模型 中 的 航行 体 所 受 的 外 力 具 体 化 ， 由 式 
(3-10)、 式 (3-13)、 式 (3-18) 和 式 (3-21) 可 以 得 到 滑翔 机 在 运动 过 程 中 所 
受到 的 可 控 外 力 〈 窍 )， 可 得 : 


F.| | AB F.|[F, 
PUPA e" 
其 中 ，F、 工 分别 表示 可 控 量 所 产生 的 力 和 力矩 之 和 。 

由 上 节 中 的 推导 ， 可 以 得 到 PETREL-II 滑翔 器 的 输入 控制 量 为 螺旋 桨 转速 
ny AV EEAB. SU ELIT REUS SE ALAUSSUS TS AO 。 

对 于 PETREL-II 7H Alas, AT UA EH CI] A DL EL EE X> Yor Zo» Ugo Yor Wo 
姿态 角 和 角速度 由 ， 和 9 ， 内 ，P ，4dq， 刀 来 表征 其 初始 状态 。 通 过 对 混合 驱动 
水 下 滑翔 器 的 控制 输入 量 (n,AB,Al,A56 ) 的 输入 ， 采 用 Matlab 中 四 阶 龙 格 库 塔 方 
法 进行 数 信 求 解 ， 进 而 得 到 混合 张 动 水 下 滑翔 夯 的 在 空间 中 位 置 和 对 应 的 速度 
(x,y,z,U,v,w)， 姿 态 角 和 角速度 (w,0,9, p,q,r)， 最 后 得 到 其 运动 时 运动 参数 随 
时 间 变 化 的 经 历 和 空间 中 的 三 维 轨迹 。 





3.4.1 混合 驱动 水 下 滑翔 顺 铅 重 面 运动 分 析 


混合 驱动 水 下 滑翔 器 在 铅 垂 面 上 的 运动 是 典型 水 下 滑翔 器 的 运动 方式 , 对 于 
PETREL-II 主要 包括 浮力 和 姿态 调节 重 物 作用 下 的 谢 面 运动 以 及 浮力 、 姿 态 调 玫 
重 物 和 螺旋 桨 作用 下 的 剖面 运动 两 种 铅 垂 面 运动 方式 。 

假设 PETREL-I 请 翔 硕 在 地 面 坐标 系 下 的 初始 位 置 为 (m,yo,zo)=(0,0,0)， 
MURA FAA (Wy, 9) 2(0,0,0) . 为 了 防止 在 Matlab 中 使 用 四 阶 龙 格 库 塔 方法 
进行 数值 求解 时 出 现 奇异 值 , 给 定 混 合 驱 动 水 下 请 翔 右 一 个 治 纵 轴 方向 的 初始 速 
RE, Be A (uvw,)2(0.0 ,.0,0) ， 单 位 m/s 。 则 初始 状态 为 ， 
(uj. Vos Wos Pos Qo» TV o Ons Po» Xo» Yo» Zo ) = (0.01,0,0,0,0,0,0,0,0) 。 
3.4.1.1 FIRRA MAIAK 823388 AÝ E E 

PETREL-II 滑翔 器 的 控制 输入 量 为 (n,AB,Al,A5)，, 其 中 螺旋 桨 转速 n 和 姿态 
i-r S UTR Vid “1 Bt AO 保持 为 零 。 

PE 7] Ae A ee Ed AN PY EZ TR] B ER ee ESM» AG) TTE 7J 28 5E 
变化 输入 函数 曲线 如 下 图 3-7 所 示 , 姿态 调节 重 物 平移 量变 化 输入 函数 曲线 如 下 
图 3-8 所 示 。 
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第 三 重 混合 驱动 水 下 滑翔 兹 动力 学 特性 分 析 





浮力 变化 量 (N) 


























PE | | | j | | | | 
? 0 500 1000 1500 2000 2500 3000 3500 4000 
J IR] Cs) 
图 3-7 滑翔 器 浮力 变化 量 
0.025- et A Ac eriam e 200020200250 Dua n uh me 
0.02- wo EE ee E EAT, PEETA TAE pote nak stents dead ae EEEE VEETEE dg dh hes et MP NETT IS ds | 
0.015- M EEEE eb E ok vetet teer ete AEE EE Rb Sn e Mod vbt OR RE tette t de t dl ends tetedett idu base ON IPOD ie | 
E 0.01- - 
Mí 
0.005- 二 | 
SE 
X c — e — ee | | 
al FO OUS Eit enun ane Dye nn ne eee tes eee rer err re rere a |: M 
ER 
m 0 -| 
KX 
-0.015- = 
a0 DE nn J 
-0.025rP- p | ABT ete z : Mo pee ie | 
0 500 1000 1500 2000 2500 3000 3500 4000 


s 





图 3-8 iE Pas ZS AS EFE E 


仿真 结果 如 图 3-9、 图 3-10. K 3-11 所 示 ， 其 中 图 3-9 为 剖面 滑翔 的 滑翔 轨 
X, B 3-10 为 姿态 角 变 化 情况 ， 图 3-11 为 滑翔 速度 变化 情况 。 

由 仿真 得 出 的 曲线 图 3-10 和 图 3-11 中 可 以 看 出 ， 泥 合 驱 动 水 下 滑翔 器 在 控 
制 输入 量 浮力 和 姿态 调节 重 物 平 移 量 的 变化 下 ， 航行 稳定 ， 在 2000s 一 个 剖面 过 
EF, REA PAREAN 150m, WiTE TB Z7 20^ 。 通 过 仿真 结果 表 
明 ， 航 迹 、 依 仰角 、 航 行 速度 比 控制 输入 量 输入 曲线 略微 滞后 ， 变 化 规律 符合 程 
度 较 好 ， 表 明 第 二 章 建立 的 仿真 模型 正确 。 
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图 3-9 浮力 驱动 模式 下 PETREL-II 深度 随时 间 变 化 
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图 3-10 浮力 驱动 模式 下 PETREL-II 纵 倾角 随时 间 变 化 




















u v w(0.001m/s) 
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图 3-11 浮力 驱动 模式 下 PETREL-II 各 速度 分 量 随时 间 变 化 
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第 三 草 混合 驱动 水 下 滑翔 器 动力 学 特性 分 析 
3.4.1.2 浮力 与 赂 旋 桨 竟 合 驱 动 模式 下 瘟 合 驱动 水 下 滑翔 器 训 面 分 析 


PETREL-I 滑翔 器 的 控制 输入 量 为 (n,AB,Al,A56) ， 其 中 螺旋 桨 转速 
n=500rpm ， 姿 态 调节 重 物 横 滚 调节 量 Ad 保持 为 零 ， 浮 力 变化 量变 化 输入 函数 
曲线 如 图 3-7 所 示 ， 姿 态 调 市 重 物 平 移 量 变化 输入 函数 曲线 如 图 3-8 所 示 。 

仿真 结果 如 图 3-12、 图 3-13、 图 3-14 所 示 ， 其 中 图 3-12 为 剖面 滑翔 的 滑 羯 
Wu, Bd 3-13 为 姿态 角 变 化 情况 ， 图 3-14 为 请 翔 速度 分 量变 化 情况 。 














0 
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图 3-12 浮力 -螺旋 桨 驱动 模式 下 PETREL-II 深度 随时 间 变 化 
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图 3-13 浮力 -螺旋 奖 驱 动 模式 下 PETREL-I 纵 倾角 随时 间 变 化 
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第 三 重 混合 驱动 水 下 滑翔 带动 力学 特性 分 析 
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图 3-14 浮力 -螺旋 桨 驱动 模式 下 PETREL-I 速度 分 量 随时 间 变 化 


由 仿真 结果 中 可 以 看 出 , 混合 张 动 水 下 滑翔 厚 在 浮力 变化 和 姿 在 调节 重 物 平 
移 量 变化 的 作用 下 ， 航 行 稳定 ， 在 2000s 一 个 剖面 过 程 中 ， 最 大 下 潜 深 度 约 为 
400m ， 较 纯 浮 力 驱 动 模式 下 港 深度 明显 增加 ， 达 航行 稳定 后 俯仰 角 约 为 20"。 念 
真 结 末 表明 ， 航 迹 、 售 仰角、 航行 速度 与 输入 曲线 吻合 民 好 ， 表 明 建 模 正 确 。 


3.4.2 混合 驱动 水 下 滑翔 器 空间 运动 分 析 


混合 驱动 水 下 滑翔 右 在 空间 上 的 运动 是 典型 水 下 滑翔 右 的 机 动 方式 -螺旋 运 
动 方式 ， 对 于 PETREL-I 主要 包括 浮力 和 姿态 调节 重 物 作用 下 的 螺旋 运动 以 及 
浮 思 、 姿 在 调节 重 物 和 螺旋 桨 作用 下 的 虹 旋 运动 两 种 空间 运动 方式 。 

假设 混合 驱动 水 下 滑翔 器 在 地 面 坐 标 系 下 的 初始 位 置 为 
(0,y0;zo)=(0,0,0)，, 初始 姿态 角 为 (wo,0,,9,)=(0,0,0) ,为 了 防止 在 Matlab 中 使 
用 四 阶 龙 格 库 塔 方法 进行 数值 求解 时 出 现 琳 弄 值 , 给 定 混 合 驱 动 水 下 滑 甚 占 沿 背 
翔 器 机 体 纵 轴 方向 一 个 初始 速度 ， 设 为 (wm)=(0.010,0)， 单 位 m/s 。 则 初 
IB SS Js (ug Vos Wo» Pos dos f Vo On» Pos Xo» Yo» Zo ) = (0.01,0,0,0,0,0,0,0,0) . 
3.4.2.1 浮力 驱动 模式 下 空间 运动 分 析 

PETREL-II 滑翔 器 的 控制 输入 量 为 (n,AB,Al,A5)，, 其 中 螺旋 桨 转速 n 保持 为 
零 ， 姿 态 调 市 重 物 模 深 调节 量 A5 、 浮 力 变 化 量 AB 和 姿态 调节 重 物 平 移 量 Al TR 
持 为 恒定 偏 移 值 ， 即 (n,AB,Al,A5)=(0,-4N,0.025m,60" ) 。 对 混合 驱动 水 下 滑翔 
途 蝶 旋 运 动 进行 仿真 分 析 ， 分 析 结 果 如 图 3-15、 图 3-16 和 图 3-17 所 示 。 
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图 3-15 浮力 驱动 模式 空间 螺旋 运动 轨迹 
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图 3-17 浮力 驱动 模式 空间 螺旋 运动 速度 分 量 
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第 三 章 混合 驱动 水 下 滑翔 器 动力 学 特性 分 析 
3.4.2.2 浮力 与 螺旋 桨 混 合 驱 动 模式 下 空间 运动 


PETREL-II 18 38 25 E] 122 ill fat A (n, AB, AL, AG) ， 其 中 螺旋 桨 转速 部、 姿态 
调节 重 物 横 滚 调节 量 A6 、 浮 力 变 化 量 AB 和 姿态 调节 重 物 平移 量 Al 保持 为 恒定 
(Fi, BN (n, AB, AL Aó) =(500rpm, -4N,0.025m, 60* )， 运 行 时 间 为 2000s。 对 混合 驱 
BN IK PIR Fa as We RIS TET HAT, APT Ze RO 3-18. K 3-19 和 图 3-20 所 
ZJN o 








X(m) og ^ -200 Z(m) 


图 3-18 浮力 与 螺旋 桨 驱动 模式 空间 螺旋 运动 轨迹 











图 3-19 浮力 与 螺旋 染 张 动 模式 螺旋 轨迹 水 平面 投影 
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第 三 重 混合 驱动 水 下 滑翔 间 动 力学 特性 分 析 
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3.5 RhA 


本 章 以 混合 驱动 水 下 滑翔 机 一 PETREL-II 为 研究 对 象 , 对 滑翔 机 系统 进行 分 
析 ， 得 到 混合 驱动 水 下 滑翔 机 的 系统 简化 醒 型 ， 在 对 简化 模型 分 析 的 基础 上 将 滑 
翔 机 在 运动 过 程 中 党 到 的 可 控 输 入 量 和 不 可 控 输 入 量具 体 化 , 并 市 入 第 二 章 所 建 
ERIZK PUT a) LA 7J 5€ 86 — FIEL v n, 并 对 具体 化 的 混合 张 动 水 下 滑翔 机 几 
何 动力 学 模型 进行 仿 趴 ， 分 析 其 放 面 请 行 和 曼 放 下 淤 的 运动 性 能 。 
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第 四 草 矢量 推进 水 下 目 主 航行 侨 动 力学 特性 分 析 


4.1 引言 





本 章 以 诛 题 组 研制 开 友 的 其 有 矢量 推进 北 贤 的 和 天 量 推 进 式 水 下 目 主 航 行 厚 
系统 为 载体 , 利用 第 二 章 推 导出 的 水 下 航行 划 儿 何 动 力学 统一 模型 , 对 深水 AUV 
系统 的 动力 学 行为 特性 进行 分 析 。 和 和 完 对 该 具有 天 量 推进 如 水 下 目 主 航行 此 系统 
进行 介绍 ,对 其 系统 构成 和 布局 进行 分 析 ， 并 对 矢量 推进 式 水 下 目 主 骸 行船 系统 
FCU ETT TRU, 利用 的 水 下 航行 几何 动力 学 统一 模型 , 分 列 完成 天 量 推进 式 水 下 
A ENT ae ECP TE. PETE AI Ze I, VR ZK AUV 的 各 种 工作 模式 下 
的 运动 特性 进行 分 析 预 测 ， 为 深水 AUV 的 设计 、 试 验 提供 帮助 。 


4.2 ABET T BEAT es Ree AT 





ACEAEXECK FE EMIT EAA ACRES ERK AUV RA, ZRA 
可 以 搭载 多 波束 测 深 仪 、 浅 地 层 剖 面 仪 、 地貌 仪 ,能够 进行 深水 海域 的 测 深 调 查 、 
海底 地 形 地 貌 调查 、 浅 地 层 地 质 结 构 调 查 等 。 该 深水 AUV 系统 具有 上 自主 航行 能 
力 、 恨 好 操控 性 能 、 精 确定 位 能 力 ， 拥 有 目 动 控制 深度 、 高 度 、 峭 同 、 三 维 姿 态 
的 功能 。 

深水 AUV 主要 性 能 指标 为 : 

(1) AKLE: 3000m; 

(2) 推进 功率 : 1.36Kw (4knot, BAW: 221N ) 0.6Kw (3knot, BH 

力 130N ) ; 

(3) 巡航 速度 : 3-5 knot ; 

(4) 续航 能 力 : 24h (3.5knot) 20h (A4knot) ; 

(50 定位 精度 : ULT 9.5m; 

(6) 搭载 重量 : 不 小 于 140kg; 

CI) 标准 任务 搭载 : ZREN, MARHA, CTD. 
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4.2.1 矢量 推进 式 水 下 自主 航行 器 系统 构成 与 布局 


矢量 推进 式 水 下 自主 航行 器 采用 直 浸 式 双 壳 体 结 构 , 双 壳 体 结 构 分 为 外 部 玻 
璃 钢 外 壳 和 内 部 密封 耐 压 壳 。 外 部 外 过 和 内 部 耐 压 壳 通过 工程 塑料 结构 件 和 相应 
的 紧 固 件 安装 固定 在 AUV ERRE. AUV 框架 梁 由 两 个 纵深 、 五 个 横梁 和 五 个 
龙骨 组 成 。 通过 在 内 部 耐 压 舱 和 外 尝 之 间 布 置 的 浮力 材料 为 航行 器 提供 浮力 。 矢 
量 推 进 式 AUV 采用 流线型 回转 体外 形 ， 外 壳 采 用 开 式 浸水 结构 ， 即 外 壳 采 用 上 
下 分 离 的 结构 ， 通 过 紧 固件 连接 到 AUV 主 框架 的 龙骨 之 上 。 矢 量 推进 式 AUV 
总 体 结构 如 图 4-1 所 示 。 








图 4-1 矢量 推进 式 AUV 忌 体 结构 


矢量 推进 式 AUV 总 体 结构 布局 ， 如 图 4-2 所 示 。 人 矢量 推进 式 AUV 总 体 结 
构 根 据 各 部 分 的 功能 、 任 务 的 不 同 ，AUYV 主体 从 前 到 后 可 以 分 为 艇 部 传 感 单元 、 
任务 搭载 单元 、 能 源 储备 单元 、 传 感 控制 与 导航 单元 和 矢量 推进 单元 。 

艇 部 传 感 单元 包括 缆 索 弹出 机 构 、CTD 声速 仪 、 高 度 计 和 避 障 雷达 ， 其 主 
要 作用 是 保证 AUV 在 航行 过 程 中 能 够 实时 探测 距 海 底 的 高 度 以 及 探测 航行 方 癌 
是 否 存在 障碍 物 。CTD 声速 仪 测量 AUV 运动 过 程 中 海水 温度 、 盐 度 和 对 应 的 深 
度 信 息 ， 并 计算 出 声速 ， 用 于 为 AUV 任务 传感器 多 波束 测 深 仪 提 供 辅 助 信 息 ， 
以 获得 更 为 准确 的 测量 值 。 绕 索 弹 出 机 构 在 AUV 回收 过 程 中 弹射 出 浮子 ， 市 出 
缆 索 ， 并 通过 回收 装置 对 AUV 进行 回收 作业 。 

任务 搭载 单元 包括 任务 电子 舱 、 侧 扫 声 响 、 浅 地 层 谢 面 仪 和 多 波束 测 深 仪 ， 
其 主要 作用 是 在 AUV 到 达 预 定海 域 、 预 定 水 深 之 后 开局 作业 ， 和 采集 并 记录 相关 
地 形 、 地 貌 信 息 。 能 源 储备 单元 主要 包括 3000 米 深 海 高 能 量 密 度 锂 电池 组 ， 该 
锂电 池 组 内 置 液压 补偿 装置 ， 使 用 水 深 范围 广 、 重 量 轻 、 体 积 小 、 供 电能 力 强 、 
安全 可 靠 、 可 重复 使 用 ， 能 够 为 AUYV 提供 充足 的 动力 源 。 
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传 感 控 制 与 导航 单元 是 AUV 系统 的 核心 部 分 ， 主 要 包括 导航 与 定位 系统 、 
主 控 系统 、 通 讯 系 统 和 安全 应 急 系 统 ， 主 要 负责 AUV 在 作业 过 程 中 的 导航 与 定 
位 、 水 面 以 及 水 下 通讯 以 及 在 意外 情况 及 生 时 的 应 急 操 作 。 

矢量 推进 单元 是 AUV 系统 的 重要 组 成 部 分 ， 为 AUV 航行 提供 动力 。AUV 
推进 单元 采用 新 型 混 联 机 构 矢量 推进 系统 ， 适 用 于 AUV 高 操纵 性 、 低 阻力 性 能 
要 求 , 能 机 工作 范围 大 , 推进 系统 性 能 得 到 提高 。 该 天 量 推进 疼 置 具有 如 下 性 能 : 
D 舵 机 角度 摆动 范围 大 ， 能 够 达到 正 负 10 度 ， 使 AUV 上 其 有 和 较 忆 的 低速 机 动 性 
和 低 阻 力 特性 ，2) RKR, TYRE VET RKENEN FETAL 
TI EVAR ZK HL. Se^ Ey. RJ — 14] JUI] ER DRE RS HR 7G 4] JE RIEKIE 
TE ARTE ARES ARN ESI Fe SLE AUV AMA HES AUV 体 坐 标 系 
B — z 轴 转 动 , 改变 水 流 冉 出 方 同 , 从 而 驱动 AUV 实现 上 浮 和 下 潜 的 功能 。 同时 ， 
螺 诞 桨 碟 动 单元 在 转 同 舵 机 及 其 传动 系统 的 市 动 下 能 够 实现 在 AUV KP al [A St 
AUV 体 坐 标 系 召 -y 轴 转动 ， 改 变 水 流 射 出 方 同 ， 从 而 驳 动 AUV 实现 转弯 的 巧 


全 已 
HE o 








传 感 控制 与 导 
— 航 定位 单元 


— 











Mos. ee ea iat 
HS PS 7 Je EBL JE 能 源 储 备 单元 矢量 推进 单元 


图 4-2 矢量 推进 式 AUV 总 体 结构 布局 


4.2.2 矢量 推进 式 水 下 自主 航行 器 系统 模型 简化 


XT HLA KOR SEAT ae, HERE EXER I T NUT S8 eu. 沿 纵 轴 方 
I] EANAR, “EVENT Ain B -xN AEE, TESI SR HUE NUI nS 
MARGRA PT, GPRD NERF RNC, Wit V PISEHJZK 2] Ie, Xt 
而 实现 转弯 或 下 淤 的 功能 。 

对 于 本 章 所 研究 的 天 量 推进 式 AUV 而 言 ， 其 尾部 安装 有 3 AEREE 
北 置 , 产生 的 推力 方 同 能 够 随 看 信仰 衣 机 和 转 回 能 机 的 转动 而 改变 。 推力 方 回 根 
所 水 下 航行 如 的 控制 策略 和 航行 任务 需要 适当 调整 。 和 天 量 推进 式 AUV 可 以 简化 
成 图 4-3 所 示 ， 其 中 包含 航行 体 坐 标 系 B— xyz 和 推进 如 坐标 系 P 了 -xyz ， 推 进 右 
坐标 系 跟随 推进 右 运 动 , 相对 于 航行 体 坐 标 系 为 动 坐标 系 。 航行 体 坐 标 系 B- xyz 
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AI HEIE a EER ARP — xyz < ERRER AR n] V E Pe TI PRIMA B o, 和 俯仰 操纵 能 
TEA 5. 来 表示 ， 两 坐标 系 之 间 的 距离 由 Ze 表示。 








图 4-3 矢量 推进 式 AUV 航行 体 坐 标 系 与 推进 器 坐标 系 


4.3 ABAD TS BEM aS RAE 


4.3.1 AS Hark h BEM Tas SIINA 


依据 4.2 市 中 矢量 推进 式 AUV 系统 的 简化 模型 , 矢量 推进 式 AUV 527] 3E 
为 重力 、 浮 为、 流体 动力 〈 包 丘 惯 性 流体 动力 和 粘性 流体 动力 ) 和 其 他 外 力 。 其 
中 ， 其 他 外 为 为 天 量 推进 项 对 AUYV ATE FS 7 Xe FFE 


4.3.1.1 流体 动力 : 惯性 流体 动力 和 粘性 流体 动力 


与 混合 驱动 水 下 背 翔 机 一 样 ， 和 天 量 推进 式 AUYV 在 流体 介质 中 运动 时 ， 由 于 
机 体 与 周围 流体 介质 相互 作用 ,也 会 产生 相应 的 作用 为 与 反作用 力 , 即 惯 性 流体 
动力 和 粘性 流体 动力 。 流 体 动 力 的 产生 机 理 在 3.3 贡 中 有 详尽 的 阐述 ， 则 和 天 量 推 
进 式 AUV 航行 过 程 中 所 受到 的 惯性 流体 动力 和 粘性 流体 动力 如 下 表述 。 
Fe HERES AUV 所 受到 的 惯性 流体 动力 为 ， 
T, =—MV (4-1) 
AU c,=[X, Y, Z, K, M, Ny) ，M 为 6x6 的 附加 质量 矩阵 。 
对 于 本 文 研究 的 矢量 推进 式 AUV 在 在 天 量 推 进占 的 作用 下 ， 其 航行 轨迹 依 
笔 天 量 推进 器 调节 ， 尾 部 的 天 量 推进 单元 没有 柠 纵 舵 面 机 构 ， 故 计算 天 量 推进 式 
AUV 的 烙 性 水 动力 时 忽略 艇 面 影响 项 ， 得 到 以 下 的 表达 式 : 
(DO,D(7)) = f (a, P.V, p.q.r) (4-2) 





其 中 ， 
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f(a, DY ，P， qi) [fi fa f Ja fs, Jel = T 
T S(Cy (0) + Cy |a| e CT |B) + Cog’ Cor + Char’ + Ct Bq) 


l 7 T i 
5 PV; SCC, (0) + Ca + Cor’ + Cy" la| C; alal + Ci |r'| + 


Ci pr "gg r^) 
I 
5 PV; S(Cz B * Cz p' + C2qg + C7" B|f| C7" qq' + C7" 
fal B+," 
































] / / / 
5 PV SLCs B+ Cp p' + Cea’ + Co^ B|B|* Ca^ qq + Ce 


+ CH |a| B+ ce 














I 
= V? SL(Cy B * Cy, p' Cu 4 + Co^ B|B|* Cu qq + Ci 














1 ala 
=~ pV; SL(Cy (0) + Cha  Cr' + C?! la| + Cs" alo - cll |r’ + 




















Ci ppl 2 o [| + r^) 
(4-3) 
AREE AUV 所 受 的 粘性 水 动力 记 做 : 
(DG) PG)! =i (4-4) 


4.3.1.2 重力 、 浮 力 以 及 扶正 力矩 


矢量 推进 式 AUV 在 航行 初始 状态 为 中 性 ， 即 重力 和 浮力 相 平 衡 。 为 保持 航 
行 的 稳定 性 ，AUV 的 重心 和 浮 心 的 不 重合 ， 即 会 产生 相应 的 扶正 力 窍 ， 如 图 4-4 
和 图 4-5 所 示 。 和 重力 和 浮力 在 航行 体 坐 标 系 下 的 表示 分 别 为 : 


0 —sin Ó 
F, =C; -G|-G|-cos0cosó (4-5) 
0 cos Asin @ 
0 -sin 8 
F,-C;|B,|-B,-cos0cosó (4-6) 
0 cos Ô sin @ 


本 文 以 矢量 推进 式 水 下 自主 航行 器 的 浮 心 为 航行 体 坐 标 系 的 原点 , 故 浮 心 对 
航行 体 坐 标 系 的 原点 力矩 为 0， 重心 位 于 航行 体 坐 标 系 中 的 六 =(0.- 07， 则 
重力 对 航行 体 坐 标 系 的 力矩 在 航行 体 坐 标 系 下 的 各 个 分 量 为 ; 


0 -sin 0 cos 0 cos à 
Teg =Neo XF; =G] -leg |x| -cos 8 cos ø | = -Gloc 0 (4-7) 
0 cos Ô sin $ sind 
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图 4-4 矢量 推进 式 水 下 目 主 航行 右 扶 正 力矩 Ca) 


A Bu 
yb | 
SL. Z A 
Ar 
CGV |. 


" 


图 4-5 AC EXEXUK PEL SENT SRTAIEZJABR. (b) 


4.3.1.3 KEER FE TI Fe RB 


如 4.2 节 中 图 4-3 所 示 , NUT VA in A B — xyz 和 推进 器 坐标 系 P-xyz 之 间 的 
REY ALLS AR AT H ES TERA EAE AA OO, FUERA ENE AN 5. 来 表示 ， 两 坐标 系 之 
间 的 距离 由 性" 表 示 。 秋 量 推进 式 AUV 的 天 量 推 进 器 的 推力 在 推进 器 坐标 系 中 
总 是 指向 P-x 轴 方向 ， 即 为 ,=(T7 0 0) ， 螺 旋 奖 产生 的 附加 转 矩 总 是 指向 
P-x 轴 负 方 向 ， 即 为 Mj;, =(-M 0 0) 。 按 照 坐标 变换 原理 ， 将 推进 器 坐标 
Z P — xyz 视 作 运动 坐标 系 ， 航 行 体 坐 标 系 B — xyz 视 作 毅 止 坐标 系 ， 两 者 之 间 的 
变换 关系 可 以 表达 成 方向 余弦 形式 。 

将 航行 体 坐 标 系 B-xyz Tei BI FEE as ^A bs A P — xyz 过 程 如 下 : 

第 一 次 ， 航 行 体 坐 标 系 Bxyz 绕 B--y 轴 旋转 角度 为 6, ， 得 到 有 -xyz , Tie 
转 和 矩阵 为 : 

coso, 0 c-sinó, 
Clo, ) = 0 1 0 (4-8) 
sino, 0 coso, 
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第 二 次 ， MERR B- xyz B-z MWERA S, 使 得 8B-x fil P- xt, 
8-y 轴 一 忆 -y 轴 ， 得 到 已 -xyz ， 旋 转 窍 阵 为 : 
coso, sino, 0 
C,..(6,)=|-sind, cosó, 0 (4-9 ) 
0 0 | 
则 由 式 (4-8), XX (4-90 可 以 得 到 航行 体 坐 标 系 Bxyz PER BUE XE A 
Ae P— xyz 的 变换 矩阵 为 : 
COSÓ,COSÓ, sinó, —cosó,sin óð, 
Co -C,.(0,)C,,(ó,)-| —sinó,cosÓ, cosó, sind, sind, (4-10) 
sin ô, 0 COSÓ, 
FHL (4-10), nTUASSIHEEE SR A tn A P — xyz 转换 到 航行 体 坐 标 系 妃 -xyz 的 
EIEREN: 
COSÓ,COSÓ, —sind,coso, sind, 
C= sin ô, cos ô, 0 (4-11) 
—coso, sind, sinó sinó, coso, 
可 以 得 到 ， 和 天 量 推进 却 AUV HJ TREE SS E) 386 7 IER RE E BJ PO 7 RE 
在 航行 体 坐 标 系 下 的 表达 为 ， 


T cos ó, cos ô, 


Bo cp. T sin ô, (4-12) 
-T cos ó, sino, 
M, cos ó, cos ô, 

M,,-C,M,-| MHM,sinó, (4-13) 
M, cos ô, sin ô, 


当 矢 量 推进 装置 螺旋 桨 产生 的 推力 已 , 与 AUV 的 纵 轴 不 重合 的 时 候 ， 由 于 
矢量 推进 力作 用 位 置 是 矢量 推进 器 坐标 系 原点 ， 其 与 AUV 航行 体 坐 标 系 之 间 相 
距 工 ,,， 则 矢量 推进 器 的 推力 对 航行 体 坐 标 系 原点 产生 的 力矩 为 ， 

0 
Me Ee T sin Lpp (4-14) 
-T cos ó, sin ó, Lpp 

则 由 式 (4-12). sh (4-13), X (4-14) 可 以 得 到 矢量 推进 装置 对 AUV 的 

EAA, JEN, 
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T cos ó, cos ô, 
T sin o, 
—T cos ô, sino, 
M , cos ó, cos Ó, 
M, sin ó, +T sin ó, Lpp 
M , cos ó, sind, — T cos ó, sind, Lpp 


FH T E ATH SHY A AE EI SEE 7 IE 2 PEPE He, 在 实际 计算 中 
EAT HIG, FY DAE KIE KEIR IER TERET © RHE) AAG HE AY ARN 73 


(4-15) 


2 
T= K pp (4-16) 
2 
M, = KopD = (4-17) 


XX (4-16) 和 式 (4-17) P: o 一 水 的 密度 ; n— BRR (r/min); DD 一 
WWE ELE: K, 一 推力 系数 ; Ky 一 力 定 系数 。 其 中 螺旋 桨 推力 系数 Kj MEER 
数 天 可 由 后 水 试验 测 得 。 


4.4 矢量 推进 式 水 下 目 主 航行 器 运动 分 析 


通过 上 市 中 对 夭 量 推进 式 水 下 自主 山行 颖 航行 过 程 中 的 受 力 分 析 , 可 以 将 第 
ZEPA (2-54) 中 所 建立 的 水 下 航行 器 的 统一 动力 学 模型 中 的 航行 体 所 受 的 外 
力 具 体 化 ， 由 式 〈4-15$) 可 以 得 到 目 主 航行 颖 在 运动 过 程 中 所 受到 的 可 控 外 力 

(FE). 

HH EAP SPE SS. A DL SUA ee PETE SUZ BOA ENT 8 A A d ri] Ee ZR T 
KREN, FeRAM o, PERMIERA 8, - 

EE IERE EA ENT ah, H A ARUMAN ENE x, y 
£95 dos Vor Wy Seas AIA PIRI y> O> Dor Por doo My RATLA MIKA. 
通过 对 控制 输入 量 (n,65,,6, ) 的 输入 ， 采 用 Matlab 中 四 阶 龙 格 库 塔 方法 进行 数值 
求解 ， 进 而 得 到 天 量 推进 式 水 下 目 主 航行 句 在 空间 中 相对 位 置 和 速度 
(x,y,z,U,v,w) ， 姿 态 角 和 角速度 (w,0,9, p,q,r)， 最 后 得 到 其 运动 时 运动 参数 随 
时 间 变 化 的 经 历 和 空间 中 的 三 维 轨 迹 。 


4.4.1 矢量 推进 式 水 下 自主 航行 器 铅 垂 面 运动 分 析 
水 下 自主 航行 器 在 铅 垂 面 上 的 运动 是 潜 浮 运动 , 对 于 矢量 推进 式 水 下 自主 航 
行 器 主要 依靠 在 俯仰 操纵 舵 舵 角 6, 的 作用 下 实现 在 铅 垂 面 上 的 下 潜 及 上 浮 运动 。 
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PUR 矢量 推进 水 下 目 主 航行 右 动 力学 特性 分 析 


假设 天 量 推进 式 水 下 目 主 航行 右 在 地 面 坐标 系 下 的 初始 位 置 和 初始 姿态 角 
分 别 为 (mm,yuz)=(0,0,0) 和 (wo,2,m)=(0,0,0) 。 为 了 防止 在 Matlab 中 进行 四 
阶 龙 格 库 塔 方法 进行 数值 仿真 时 出 现 奇异 值 , 天 量 推进 式 水 下 目 主 航行 卉 的 初始 
速度 设 为 (wu,vo,w)=(0.01,0,0)， 单 位 m/s 。 则 水 下 自主 航行 器 的 初始 状态 为 
(Ug. Vos Wo» Do» do» oWo» Obs Po» Xo» Yo» Zo )=(0.01,0,0,0,0,0,0,0,0) ,在 仿真 分 析 过 程 中 
航行 占 的 控制 输入 量 (n,6,,5, ) 的 变化 曲线 图 4-6 Bras, FS ATT ot CE aE E 
的 轨迹 图 如 图 4-7 所 示 , i GAR AS HIIT a UIT BS ICRC AA 8, HIE 
合 民 好， 建立 的 模型 正确 。 
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图 4-6 矢量 推进 间 控 制 输 入 量 的 变化 
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图 4-7 矢量 推进 式 水 下 自主 航行 器 铅 垂 面 潜 浮 轨迹 
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第 四 章 矢量 推进 水 下 上 自主 航行 器 动力 学 特性 分 析 
4.42, 矢量 推进 式 水 下 自主 航行 器 水 平面 运动 分 析 


水 下 目 主 航行 右 在 水 平面 上 的 运动 是 回转 运动 , 回转 运动 能 够 在 一 定 程度 上 
体现 出 航行 句 的 操纵 性 能 。 对 于 和 天 量 推进 式 水 下 目 主 航行 句 主 要 依靠 在 转 辐 操 纵 
TURO AA 6, 的 作用 下 实现 在 水 平面 上 的 上 的 回转 运动 。 

假设 矢量 推进 式 水 下 自主 航行 器 在 地 面 坐标 系 下 的 初始 位 置 和 初始 姿态 角 
分 别 为 (yo0,zo)=(0,0,0) 和 (wo,0,9,)=(0,0,0)。 为 了 防止 在 使 用 Matlab 进行 
四 阶 龙 格 库 塔 方法 进行 数值 求解 时 出 现 奇 异 , 天 量 推进 陈 水 下 目 主 航行 卉 的 初始 
速度 设 为 (u,vo,w,)=(0.01,0,0)， 单 位 m/s 。 则 水 下 自主 航行 器 的 初始 状态 为 
(Ug. Vos Wo» Dos do» I9» Vo» 05. Pos Xo» Yo» Zo ) =(0.01,0,0,0,0,0,0,0,0) ,在 仿真 分 析 过 程 中 
航行 器 的 控制 输入 量 保 持 (n,6,,5,)=(400rpm,8",0), 得 到 的 水 平面 回转 曲线 如 图 
4-8 所 示 ， 曲 线 表 明 航 行 费 在 水 平面 上 的 回转 特性 民 好 ， 建 模 正 确 。 
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图 4-8 矢量 推进 式 水 下 自主 航行 器 水 平面 回转 运动 轨迹 


4.4.3 矢量 推进 式 水 下 自主 航行 器 空间 运动 分 析 


水 下 目 主 航行 硕 在 空间 中 的 运动 是 螺旋 运动 , 螺旋 运动 能 够 在 一 定 程度 上 体 
现 出 航行 器 的 操纵 性 能 和 下 洲 性 能 。 对 于 天 量 推进 式 水 下 目 主 航行 右 主 要 依靠 在 
ARE AH ENE 6. o, RUE I8] PR UTERE fai o, 的 作用 下 实现 在 空间 中 的 上 的 螺旋 运 
动 。 

假设 矢量 推进 式 水 下 自主 航行 器 在 地 面 坐 标 系 下 的 初始 位 置 和 初始 姿态 分 
别 为 (%,y6,zo)=(0,0,0) 和 (yw,@,9,)=(0,0,0)。 为 了 防止 在 Matlab 中 使 用 四 阶 
龙 格 库 塔 方法 进行 数值 仿真 时 出 现 奇 寞 值 , 矢量 推进 式 水 下 目 主 航行 融 的 初始 速 
度 设 为 (u,v,wo)=(0.01,0,0)， 单 位 m/s 。 则 水 下 自主 航行 器 的 初始 状态 为 ， 
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PUR 矢量 推进 水 下 目 主 航行 右 动 力学 特性 分 析 


(Ug. Vos Wo» Po» Foe!» Wo» Ob» Pos Xo» Yo» Zo ) = (0.01, 0,0,0, 0,0,0, 0,0) .在 仿真 分 析 过 程 中 
航行 器 的 控制 输入 量 保持 ( 普 2,,6.)=(400rpm,8 ,-10 ) ， 得 到 的 空间 中 螺旋 曲线 
如 图 4-9 所 示 ， 曲 线 表 明 航 行 器 在 空间 中 的 操纵 性 能 良好 ， 建 模 正 确 。 


Z (m) 








图 4-9 矢量 推进 式 水 下 自主 航行 器 空间 螺旋 运动 轨迹 


4.5 本 和 草 小 结 


AN eA ee HERES PE EMT a TAK AUV AMAT A, NNT as Bt 
进行 分 析 ， 得 到 天 量 推进 式 AUV 的 系统 简化 模型 ， 在 对 人 简化 模型 分 析 的 基础 上 
将 AUV 在 航行 运动 过 程 中 受到 的 可 控 输入 量 和 不 可 控 输 入 量具 体 化 ， 并 代入 第 
二 半 所 建立 的 水 下 航行 退 统 一 几何 动力 学 模型 中 ， 并 对 具体 化 的 矢量 推进 式 
AUV 几何 动力 学 模型 进行 仿真 ， 分 析 其 铅 王 面 潜 六 运动 、 水 平面 回转 运动 和 坚 
旋 下 潜 的 运动 性 能 。 
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第 五 草 水 下 航行 器 湖 试 和 海 试 研究 


5.1 引言 


试验 是 海洋 装备 设计 研究 过 程 中 重要 的 方法 ， 对 于 水 下 航行 器 的 设计 开发 ， 
试验 研究 必 不 可 少 。 通 过 试验 研究 , 设计 人 员 可 以 获取 水 下 航行 器 的 各 项 性 能 参 
数 指标 ， 解决 一 系列 的 实际 问题 ,同时 对 数值 计算 方法 可 行 性 进行 验证 ， 进 而 对 
水 下 航行 器 设计 研究 的 技术 路 线 进行 检验 , 为 水 下 航行 器 后 续 的 改进 及 再 设计 提 
供 试验 依据 。 

针对 水 下 航行 器 的 试验 主要 包括 设计 前 期 的 单元 试验 和 设计 后 期 的 整 机 水 
域 航行 试验 。 其 中 整 机 水 域 航行 试验 能 够 测试 水 下 航行 器 各 项 性 能 指标 是 否 达 到 
设计 要 求 。 此 外 通过 整 机 水 域 航行 试验 能 够 验证 水 下 航行 器 总 体 性 能 、 各 个 组 成 
单元 之 间 的 相互 协调 性 、 完 备 性 和 可 靠 性 。 通 过 水 域 航行 试验 能 够 及 时 发 现 航 行 
aa ETE ORB, FEET EE 

本 章 主 要 对 混合 驱动 水 下 滑翔 器 PETREL-I 和 矢量 推进 式 水 下 自主 航行 器 - 
深水 AUV 的 整 机 海 试 试验 研究 进行 分 析 ， 包 括 : PETREL-I 78 33 5578 3E D UH 
翔 性 能 试验 和 矢量 推进 式 深水 AUV 海域 内 航行 性 能 试验 。 


5.2 混合 驱动 水 下 滑翔 器 湖 试 和 海 试 研究 


项 目 组 对 混合 驱动 水 下 滑翔 器 PETREL-II 各 个 单元 模块 在 完成 独立 测试 、 
调试 的 基础 上 进行 集成 ， 并 进行 整 机 联 调 。 在 整 机 联 调 的 过 程 中 ， 首 先 在 天 津 大 
学 青年 湖 进行 整 机 性 能 测试 以 及 改进 ,包括 滑翔 器 水 面 通 讯 测 试 、 甲 板 单 元 测试 、 
滑翔 机 姿态 调节 能 力 测 试 和 滑翔 机 水 面 跑 航 能 力 测 试 。 通 过 在 天 津 大 学 青年 湖 的 
整 机 性 能 测试 ， 对 混合 驱动 水 下 请 翔 右 系 统 的 整体 可 靠 性 进行 初步 验证 。 然 后 项 
目 组 相继 于 2012 年 12 月 底 和 2013 年 4 月 初 分 两 次 前 往 云 南 省 澄江 县 抚 仙 湖 对 
滑翔 器 进行 各 功能 模块 可 靠 性 验证 、 清 翔 运动 性 能 验证 和 航行 运动 性 能 验证 ， 对 
滑翔 器 的 大 航程 、 大 深度 滑翔 剖面 性 能 、 水 面 跑 航 性 能 、 水 下 定 深 航行 性 能 进行 
初步 验证 。2013 年 7 月 中 旬 ， 清 翔 右 项 目 组 在 我 国 南 海 西沙 海域 对 滑翔 器 进行 
了 海域 性 能 试验 ,对 滑翔 右 连 续 训 面 滑翔 运行 、 不 同 海 况 下 布 放 回收 和 大 这 度 航 
行 性 能 进行 验证 。 
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第 五 章 水 下 航行 器 湖 试 和 海 试 研究 
5.2.1 混合 驱动 水 下 消 翔 器 前 面 疹 翔 运动 试验 研究 


PETREL-I 清 翔 堪 的 主要 工作 模式 为 铅 垂 面 上 的 滑翔 运动 , 在 样机 的 试制 阶 
段 对 其 性 能 测试 必 不 可 少 。 图 5-1 为 项 目 组 在 南海 西沙 海域 PETREL-I 性 能 试验 
图 片 ， 试 验 海域 水 深 200m， 准备 下 潜 点 经 纬度 坐标 为 (111.0703E,184042N)， 设 
定 航 线 为 北 偶 西 方向 ， 如 图 中 篆 头 指 癌 所 示 。 滑 翔 右 进行 连续 训 面 航行 四 次 ， 每 
次 剖面 滑行 结束 之 后 进行 水 面目 定位 并 与 甲板 单元 通讯 ， 并 进行 下 一 个 剖面 航 


ZZ 


行 。 


| 
| 
| 
| 


浅海 试验 区 和 潜 航 轨迹 (水深 200m) 


f 111.0633E.18.4150 N à 
SOR 111.0689 E:184072 N 


“18.4136 N OO oon AUC 
S | L11:0606 E: 184167 N 
HL (675 E,18.4086 DM 


滑翔 机 试验 区 111.3328 E, 18.3050 NE] 11.3333E. 18.3031 N 


111.3331 E 18.3053N 111.3308E, 18.3078 N 





图 5-1 PETREL-I 南海 西沙 试验 海域 


由 于 海流 和 风 良 的 存在 ， 靖 翔 带 在 水 面 定 位 与 通讯 的 期 间 滑翔 夯 随 衣 逐 沉 ， 
有 一 定 的 深 移 量 。 图 5-2 为 水 下 滑翔 厚 在 四 次 连续 训 面 运动 过 程 中 的 轨迹 ， 星 号 
为 滑翔 右 水 面 定 位 位 置 ， 市 有 鼻头 的 实 线 为 请 翔 奏 水 下 请 暑 轨 迹 ， 虚 线 部 分 为 水 
面 洒 流 的 轨迹 。 在 滑翔 右 四 次 连续 谢 面 运动 过 程 中 , 第 一 次 训 面 运动 历时 1000s, 
请 翔 深度 为 50m 区 在 ， 第 二 、 三 和 四 次 剖面 运动 历时 1700s， 清 翔 深度 均 超 过 
150m, 与 第 三 革 3.4 节 中 滑翔 郁 训 面 运动 仿真 曲线 符合 度 较 好 ， 和 表明 靖 翔 郁 仿 真 
模型 的 正确 性 。 
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图 5-2 PRTREL-II 连续 滑翔 剖面 轨迹 





111.074 


图 5-3 为 滑翔 器 连续 四 个 剖面 运行 过 程 中 控制 输入 量 : Une. eS 
与 滑翔 器 啊 应 输出 量 : 俯仰 角度 、 垂 直 速 度 和 下 淤 深度 之 间 的 关系 。 由 关系 曲线 
可 以 看 出 清 翔 器 的 控制 输入 量 与 啊 应 输出 量 之 间 的 啊 应 程度 展 好 。 图 5$-4 和 图 5-5 
是 PETREL-I 搭载 的 任务 传感器 CTD 在 剖面 航行 过 程 中 采集 的 温度 、 盐 度 随 深 
度 变化 的 关系 。 
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图 5-3 PETREL-II 连续 滑翔 剖面 运 
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图 5-4 连续 4 个 谢 面 运动 各 度 与 深度 数据 
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5.2.2 混合 驱动 水 下 滑翔 顺 定 深航 行 运动 试验 研究 


PETREL-I 作为 一 种 新 型 的 水 下 航行 器 ， 尾 部 没有 操纵 艇 面 , 仪 依靠 姿态 调 
节 重 物 对 航行 器 的 姿态 、 航 向 进行 调节 。 项 目 组 于 2013 年 4 月 中 旬 在 云南 抚 仙 
湖 对 PETREL-II 定 深 航行 特性 进行 试验 研究 。PETREL-I 下 水 之 后 , 依靠 典型 的 
滑翔 模式 进行 下 洲 ， 到 达 预 定 深 度 之 后 通过 调节 油 宫 油 量 使 滑翔 器 净 浮 力 为 0， 
并 同时 调节 姿态 调节 重 物 ， 使 滑翔 器 傣 仰 姿态 体 持 水 平 ,在 尾部 推进 痛 置 的 作用 
下 进行 定 深 航行 。 图 5-6 为 PETREL-I 在 抚 仙 湖 40m 定 深航 行 运行 参数 关系 ， 
表明 PETREL-I 能 够 在 一 定时 间 范 围 内 进行 定 定 深 短 行 ， 定 深 质 行 上 共有 一 定 的 
可 控 性 。 
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图 5-6 PETREL-II 定 深 航行 运行 参数 关系 


5.3 矢量 推进 式 水 下 自主 航行 器 海 试 研究 


项 目 组 计 对 矢量 推进 式 深水 AUV 试验 样机 进行 了 大 量 的 单元 模块 测试 和 整 
机 性 能 跑 航 测试 。 相继 在 天 妾 大 学 青年 湖 进行 多 次 里 元 模块 验证 和 整 机 跑 航 初步 
验证 , Jae 2011 年 11 月 份 在 天 妾 鲁 县 于 桥 水 库 进 行 水 域 试 验 主要 对 航行 右 水 面 
跑 航 进行 验证 ， 并 对 航行 费 下 潜 运 动 进行 初步 验证 。2011 年 12 月 份 项 目 组 赴 云 
Fg cid Hr ERE. 750 研究 所 试验 场 对 航行 融 下 浴 性 能 和 水 下 定 深 、 定 局 等 跑 航 
性 能 进行 试验 ， 并 对 航行 锅 变 深度 航行 能 力 进 行 验证 。2013 年 11 月 份 ， 项 目 组 
在 渤海 海域 对 在 不 同 海 况 下 航行 各 大 航程 定 深 、 定 局 跑 航 试验 进行 测试 , 并 采集 、 
记录 了 大 量 珍 贯 的 试验 数据 。 





图 5-7 矢量 推进 式 水 下 自主 航行 器 水 域 航行 
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53.1 矢量 推进 式 水 下 自主 航行 器 渤海 海 试 研究 


水 下 定 高 航行 是 自主 式 水 下 航行 器 实现 海底 地 形 跟踪 、 地 形 地 貌 调 查 以 及 完 
成 避 障 功能 所 必须 的 能 力 。2013 年 11 月 份 项 目 组 在 济 海 海域 对 天 量 推进 式 水 下 
自主 航行 句 在 有 海流 干扰 的 情况 下 ， 大 航程 的 定 高 航行 试验 。 图 5-8 为 试验 海域 
航行 规划 图 ， 航 行 器 航行 规划 路 径 为 ?kmx2knm 的 正方 形 ， 正 方形 轨迹 四 个 顶点 
经 纬度 坐标 依次 为 : 1 点 (38.494124N, 120.264359E) 一 11 点 (38.494124N, 
120.246373E) —21 点 (38.476138N, 120.246373E) 一 31 点 (38.476138N, 
120.264359E) 。 由 于 有 海流 的 影响 ， 为 使 航行 匿 航行 过 程 中 具有 更 好 的 巡 线 功 
能 ， 在 四 个 边 之 间 每 隔 200m 距 离 设 定 一 个 航 迹 调整 点 ， 如 网 5-8 所 示 。 图 中 实 
线 箭 头 指向 为 实测 海流 方向 。 航 行 器 在 8 点 位 置 准 备 下 潜 ， 进 行距 离 海 底 7m 定 
高 航行 ， 航 行 方 同 为 图 中 虚线 第 头 指 回 ， 在 沿 设 定 航 线 航 行 一 闭 之 后 返回 水 面 。 


























图 5-8 航行 规划 图 


航行 器 在 航行 过 程 中 ， 在 航 迹 点 11 点 和 21 点 之 间 的 航行 期 间 ， 由 于 受到 
1.5 节 海 流 的 影响 ， 需 行 希 定 高 航行 距 展 高 度 和 巡 线 功能 受到 一 定 影响 ， 航 行 春 
7m 定局 航行 三 维 轨迹 如 图 5-9 所 示 , Ed ep KR STR Ie] Ay Sc ETC 77 [A] « Ad 5-10 
和 图 5-11 AAT ae 7m FE TST SBS 6, h FS p n] PUE HUUAT SLT T E 
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"EE CEBUI RE. MEME TERE A EA RED APR, TESESUU IS 
海流 的 作用 影响 下 出 现 小 范围 的 波动 , AERE RE 3 a HEHE RS E Td EE FP AT 
伦 艇 角 ， 航 行 体 航 行 状 态 得 到 调节 ， 最 终 趋 于 稳定 ， 般 行 过 程 中 最 大 航行 速度 达 
到 3 节 ， 满 足 设 计 要 求 。 
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图 5-9 渤海 海域 7m 定 高 航行 轨迹 
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图 5-10 济 海 海域 7m 定 高 航行 运行 参数 变化 a 
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图 5-11 渤海 海域 7m TE ifie f1 SACL Cb) 


5.4 Zk zii £d 


AS EDO VR eZ OT SU A Rr AK. PH Has PETREL-I 和 矢量 推进 式 
IK PB ERAT ARIT BELA LTT VAS EU, SEUENLAT us tr UE ETP o X312 JJ 
irse SED LKBUUtT WC. SBE PE RA, 仿真 曲线 
在 一 定 范 围 内 与 试验 所 得 到 的 航行 参数 匹配 较 好 , 进而 验证 了 第 二 章 所 建立 的 水 
下 航行 右 几 何 动 力学 统一 模型 的 正确 性 。 
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BNE 结论 与 展望 


6.1 全 文 结论 


本 文 在 课题 组 以 往 研究 的 基础 上 ,建立 水 下 航行 器 通用 的 动力 学 模型 ， 并 对 
诛 题 组 研制 的 两 球 航 行 如 系统 建 模 , 进行 仿真 分 析 。 退 过 与 湖 试 、 海 试 试 验 对 比 ， 
验证 该 通用 模型 的 正确 性 。 本 文 的 主要 研究 成 果 如 下 : 

1. 针对 水 下 航行 馨 在 流体 介质 中 运动 的 特点 ， 从 能 量 的 角度 出 及， 推导 出 
水 下 航行 占 的 动力 竺 方程 ,根据 水 下 航行 费 作 为 一 种 特殊 的 机 械 系 统 的 符 点 ， 由 
水 下 航行 莫 质 量 滤 阵 引 入 柳 曼 度量 ， 对 水 下 航行 占 的 动力 竺 模型 进行 几何 推导 ， 
得 到 基于 微分 几何 理论 的 水 下 航行 厚 动 力学 通用 蛋 型 。 

2. 通过 对 混合 驱动 水 下 滑翔 器 PETREL-I 系统 分 析 , 得 到 其 简化 系统 模型 ， 
将 简化 系统 模型 受 力 情况 代入 到 水 下 航行 妖 动 力 柑 型 中 ,进行 仿真 分 析 。 仿真 分 
析 结 果 与 试验 数据 对 比 ， 验 证 通用 模型 的 正确 性 。 

3. 通过 对 矢量 推进 式 水 下 自主 航行 右 系 统 分 析 ， 得 到 矢量 推进 系统 的 简化 
模型 ,将 该 系统 受 力 情况 市 入 到 水 下 航行 费 动 力 模 型 中 ， 进行 仿 真 分 析 。 念 真 分 
析 结 果 与 试验 数据 对 比 ， 验 证 通用 模型 的 正确 性 。 


6.2 工作 展望 


本 文 建 六 了 基于 做 分 几何 理论 的 水 下 航行 右 动 力学 模型 , 并 将 模型 应 用 到 两 
款 典 型 的 水 下 航行 器 中 , 仍然 存在 不 是 和 改进 之 处 。 在 本 文 的 基础 上 可 进一步 进 
47 — FUL: 

1. AS SCS AERA IRE TIT al PETC, EOE BOA Tal PA, 
Via Fe LYE n] UR AFT PUTT ee ARS, EOE NESE HY AR 

2. 本 文 所 用 到 水 动力 系数 多 为 经 验 值 ， 可 以 通过 实验 或 仿真 得 到 更 为 精准 
的 水 动力 值 ， 代 入 模型 中 ， 以 获得 更 精确 的 模型 。 

3. 在 基于 做 分 儿 何 理论 水 下 航行 融 动 力学 模型 的 基础 之 上 ， 研 究 水 下 航行 
器 的 控制 策略 ， 构 建 基 于 微分 几何 控制 理论 的 控制 系统 ， 如 时 间 最 优 控制 策略 、 
轨迹 最 优 控制 东 略 等 。 
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Parameters [J]. SEA TECHNOLOGY, 2013, 54(8): 57-4. (SCI 期 刊 , 已 检索 ， 


检索 号 ; 203NQ) 


参加 科研 情况 : 
1l. 国家 上 自然 科学 基金 , “面向 海洋 剪 切 流 测 量 的 水 下 滑翔 器 设计 方法 与 
鲁 棒 控制 研究 ”， 编 号 51005161。 
2， 国 家 科技 重大 专项 “大 型 油气 田 及 煤层 气 开发 " 子 课题 ，“ 深 水 AUV 
系统 设计 与 制造 技术 研究 ”， 编 号 2008ZX05027-004-03。 
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本 论文 的 工作 是 在 我 的 导师 王 延 辉 副 教授 的 甘心 指导 下 完成 的 , FEE 
授 严 刘 的 治学 态度 ， 科 学 的 工作 方法 , WADER m IERRA E 
延 涟 老师 能 够 把 握 研 究 领 域内 的 技术 现状 和 最 新 友 展 动态 , 在 平时 的 科研 生活 中 
给 予 很 多 的 指导 和 意见 ， 对 我 的 和 学习、 科研 和 生活 有 极 大 的 帮助 和 影响 。 在 此 衷 
心 感谢 研究 生 阶 段 两 年 半 来 王 延 辉 老 师 对 我 的 关心 和 指导 。 

同时 ,张宏伟 副教授 悉心 指导 我 们 完成 了 实验 室 的 科研 工作 , 在 学 习 上 和 生 
活 上 都 给 予 了 我 很 大 的 关 必 和 帮助 , 张宏伟 老师 严谨 的 工作 作风 给 予 我 很 深 的 影 
啊 ， 在 此 回 张 宏伟 老师 表示 衷心 的 谢意 。 

由 衷 的 感谢 项 目 组 的 其 他 老师 。 王 树 新 教授 在 平时 的 科研 工作 和 日 弟 生 活 中 
给 予 我 很 多 指导 。 黎 大 展 工程 师 在 项 目 过 程 中 以 其 丰富 的 实践 经验 对 我 的 工作 手 
出 很 多 建议 和 指导 。 刘 玉 红 副教授 和 吴 之 完 老 师 对 我 的 科研 工作 和 科 撤 论文 与 作 
部 提出 了 许多 的 宇 吐 意见 ， 在 此 表示 此 心 的 感谢 。 

感谢 实验 室 王 关 宁 老师 、 张 连 洪 教授 和 何 相 宕 副教授 ,他 们 在 研究 生 学 习 生 
活 中 给 予 了 我 很 大 帮助 。 

EKW TERRIA, SERLE, AEETI FRR 
AWA, FLA. SHAE. BOR AR. ORES BR. ERS A 
撰写 提出 了 许多 宝 叶 意见， 对 我 研究 工作 给 予 了 热情 帮助 ,在 此 癌 他 们 表达 我 的 
感激 之 情 。 

为 外 也 感谢 父母 、 姐 姐 、 女 朋友 以 及 其 他 朋友 ,他 们 的 理解 和 支持 使 我 能 够 
专心 完成 和 学业， 是 他 们 的 理解 和 支持 让 我 顺利 的 度 过 了 研究 生生 活 , 在 此 我 深 深 
的 迹 上 我 的 馈 音 和 感谢 。 
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